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Abstract 


A  PATH  PLANNING  AND  OBSTACLE  AVOIDANCE 
HYBRID  SYSTEM  USING  A  CONNECTIONIST  NETWORK 

Christopher  Emmet  Schuster 


Automated  path  planning  and  obstacle  avoidance  has  been  the  subject  of  intensive 
research  in  recent  times.  Most  efforts  in  the  field  of  semiautonomous  mobile-robotic 


navigation  involve  using  Artificial  Intelligence  search  algorithms  on  a  structured 
environment  to  achieve  either  good  or  optimal  paths.  Other  approaches,  such  as 
incoiporating  Artificial  Neural  Networks,  have  also  been  explored.  By  iiiq)lementing  a 
hybrid  system  using  the  parallel-processing  features  of  conncctionist  networks  and  simple 
localized  search  techniques,  good  paths  can  be  generated  using  only  low-level 
environmental  sensory  data.  This  system  can  negotiate  structured  two-  and  three- 
dimensional  grid  environments,  from  a  start  position  m  a  goal,  while  avoiding  all  obstacles. 
Major  advantages  of  this  method  are  that  solution  paths  are  good  in  a  global  sense  and  path 
planning  can  be  accomplished  in  real  time  if  the  system  is  implemented  in  customized 


parallel-processing  hardware.  This  system  has  been  proven  effective  in  solving  two-  and 
three-dimensional  maze-type  enviroiunents. 
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CHAPTER  1 
Introduction 


An  important  use  for  path  planning  and  obstacle  avoidance  systems  is  the  control  of 

semiautonomous  mobile  robots.  Robotic  navigation  involves  controlling  the  movement  of 

a  vehicle  from  one  location  to  another.  While  this  problem  seems  trivial  for  humans,  such 

is  not  the  case  for  our  electro-mechanical  creations.  The  problem  can  be  further 

complicated  when  travel  requires  movement  through  an  unstructured,  possibly  changing, 

and  complex  three-dimensional  environment  Currently,  most  systems  in  use  force  the 

human  operator/  user  to  constantly  control  the  robot's  movement  through  a  tele-operations 

link,  using  'wire,  radio,  or  fiber-optics  as  the  information  transfer  medium.  Automating  the 

basic  navigation  ability  of  a  robot  would  greatly  sin^jlify  the  human  tele-operation 

requirements  and  allow  for  greater  concentration  on  whatevCT  task  is  to  be  accon^}lished 

when  the  robot  reaches  its  goal  location. 

At  Rice  University  alone,  tiie  Mechanical  Engineering  Robotics  Group  has  been 

actively  investigating  alternative  strategies  for  robotic  sensing,  navigation  and  control.  [See 

WeUand  (1989),  Wu  (1989),  Norwood  (1989),  Cheatham  (1987  &  1989),  Adnan  (1990), 

and  Regalbuto  (1988  &  1990).]  Possible  applications  of  this  technology  are: 

Semiautonomous  na'vdgation  control  system  for  the  future  NASA  Mars  Rover 
e>q)loration  vehicle. 

Household  mobile  robotic  aids  for  the  severely  handicapped. 

Automated  roadmap  routing  system  for  use  by  police,  fire,  and  ambulance 
emergency  vehicle  drivers,  as  well  as  tourists,  cabbies,  delivery  service  vehicle 
operators,  etc. 

Mobile  robotic  vehicle  movement  control  system  for  travel  between  and  through 
building(s)  to:  deliver  parts,  mail,  sentry/  security  patrol,  cany  people,  etc. 


♦  ♦ 
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The  list  above  only  hints  at  the  possibilities  for  a  reliable  automated  navigation  system 
which,  when  combined  with  the  proper  sensor/  feedback  apparatus  and  mobile  base,  can  be 
used  for  a  very  wide  variety  of  purposes.  As  an  example.  Figure  1  shows  a  layout  for  one 
floor  of  a  small  office  building.  One  of  the  goals  of  this  research  is  to  develop  an  efficient 
path  planning  system  which  would  allow  a  robot  to  travel  throughout  a  similar  multistory 
building  environment  to  deliver  mail,  materials,  etc. 


Figure  1 

An  Example  Path  Planning/  Obstacle  Avoidance  Environment 


The  assumptions  made  are:  1)  there  is  a  sensor/  feedback  system  in  place  which 
provides  simple  global  environmental  binary  data  input  (i.e.  represent  space  as  a  3D  'grid' 
of  obstacle  vs.  free  space  unit  cubes),  2)  the  mobile  robot  is  capable  of  2D  movement  in 
eight  directions  (increments  of  45  degrees),  3)  the  data  grid  scaling  is  suitable  for 
considering  the  robot  a  point  mass  (or  possible  pre-processing  of  data  to  expand  obstacles 
sufficiently  to  avoid  collisions),  and  4)  other  robot  control  routines  are  available  to 
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accurately  update  current  position,  handle  opening/  movement  through  doors  and  elevators, 
and  any  other  tasks  desired. 

Traditional  methods  for  path  planning  and  obstacle  avoidance  control  use  artificial 
intelligence  search  algorithms  on  sequential  conq)uters,  however  these  algorithms  normally 
do  not  provide  real  time  control  in  a  complex  or  changing  environment  and  most  are  very 
susceptible  to  problems  caused  by  noisy  or  incomplete  environmental  input  data.  For  every 
special  case,  another  routine  has  to  be  devised  and  programmed.  One  powerful 
computational  alternative  is  a  system  featuring  conqjonents  roughly  modeled  on  biological 
neural  networks.  These  networks  have  advantages  due  to  their  highly  interconnected/ 
parallel  architectures. 

The  task  investigated  here  is  the  use  of  a  hybrid  electronic  connectionist  network 
system  for  path  planning  and  obstacle  avoidance  using  only  low-level  environmental 
sensory  input  data.  The  system  is  called  a  hybrid  due  to  its  use  of:  1)  a  combination 
binary  input/  analog  ouq)ut  resistive  network  which  can  be  initialized,  with  sensory  data,  to 
represent  a  complex  environment  (called  a  coimectionist  network  due  to  its  highly 
interconnected  nodal  structure),  2)  a  second  'feed-forward'  network  which  analyses  the 
output  of  the  connectionist  network  and  provides  local  path  move  guidance,  and  3) 

auxiliary  digital  control  circuitry  to  handle  the  path  finding  procedure  fix>m  start  node  to 

✓ 

goal.  By  properly  fixing  the  voltage  outputs  for  start  and  goal  points,  along  with 
modifying  (disconnecting)  connections  to  obstacles,  the  connectioiust  network  can  be 
caused  to  output  useful  information.  The  output  of  the  connectionist  network  can  be 
analyzed  quickly  by  the  second/  feed-forward  local-move-finder  network  and  additional 
circuitry  to  yield  good  path  solutions  for  the  given  problem.  The  potential  advantages  of 
using  this  hybrid  connectioiust  network  system  are  speed,  due  to  the  massively  parallel 
architecture;  the  ability  to  function  reasonably  with  noisy  and  incomplete  input;  and 
efficient  handling  of  changing  environmental  parameters.  Neural-type  networks  have  also 
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been  found  to  have  an  uncanny  ability  to  survive  minor  damage/  loss  of  internal  circuitry 
(much  like  the  human  brain,  which  functions  even  though  neurons  are  constantly  expiring). 

This  research  was  divided  into  two  phases.  First  was  the  design  and  construction 
of  a  hardware  implementation  of  a  modest  hybrid  coimectionist  network  system,  here-on 
called  the  Maze  Machine.  The  machine  was  built  to  prove  and  refine  concepts  and 
demonstrate  feasibility  for  a  much  more  ambitious  VLSI  irr^lementation.  The  second 
phase  of  the  research  consisted  of  writing  the  software  program  AMAZ3D  which  simulates 
the  Maze  Machine's  behavior  on  a  sequential  computer  and  allows  for  testing  of  much  more 
complex  navigation  problems. 


Sample  Maze  Initialization 


Key: 

llll  Obstacle 
I  I  Free  Space 
[G1  Goal 


Start 


Figure  2 

A  Specific  Maze  Machine  Problem  Environment 


The  Maze  Machine  took  the  first  step  by  solving  simple  two-dimensional  'maze' 
navigation  problems.  With  the  assistance  of  William  T.  Atkinson,  a  small  scale  hybrid 
electronic  connectiorust  device  was  designed  and  built  which  can  solve  a  subset  of  tire 
desired  navigation  problem.  The  subset  problem  consists  of  movement  through  a  two- 
dimensional  enviromnent  where  only  four  moves  are  allowed  fiem  a  given  point  Using 
Cartesian  space,  these  directions  are  plus  or  minus  X  and  plus  or  minus  Y  (latCT  referred  to 
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as  East,  West,  North,  and  South  respectively).  The  two-dimensional  environment  is 
further  limited  to  a  seven-by-seven  grid,  or  matrix,  of  possible  locations.  Each  location,  or 
'node',  will  be  externally  designated  as .  of  four  types:  1)  obstacle,  2)  free  space,  3) 
goal,  or  4)  start.  The  problem  environirent  is  graphically  shown  in  Figure  2.  Note  that 
the  outer  boundary  around  the  maze  is  also  treated  as  an  'obstacle'  region,  thMefore 
movement  is  constrained  to  remain  in  the  seven-by-seven  maze. 

Having  a  working  version  of  the  hybrid  system  not  only  demonstrated  the  validity 
of  the  concepts  presented,  but  also  provided  the  drive  to  conduct  further  research  into 
possible  construction  of  systems  with  much  greater  capatnlity.  Rather  than  immediately 
attempt  the  construction  of  custom  analog  VLSI  chips  to  extend  the  capabilities  of  the  Maze 
Machine,  the  second  phase  of  the  research  consisted  of  writing  a  software  program  to 
simulate  the  operation  of  the  hybrid  system  on  a  sequential  computer.  Thus  the  system's 
capabilities  could  be  greatly  expanded  and  many  more  tests  could  be  run  cheaply,  while 
only  sacrifrcing  the  speed  advantage  that  would  be  gained  by  a  true  parallel  processing 
network  system. 

The  current  version  of  the  AMAZ3D  program  is  capable  of  handling  any  size  three- 
dimensional  grid-type  environment  (limited  only  by  the  memory  capacity  of  the  computer 
being  used).  The  allowable  move  directions  from  a  given  point/  node  have  been  expanded 
to  allow  for  eight  directions  in  the  horizontal  plane  (labeled  North,  Soutii,  East,  West, 
North-East,  North-West,  South-East,  and  South-West)  and  two  directions  in  tiie  Vertical 
plane  labeled  Up  and  Down).  These  added  capabilities  allow  for  the  creation  of  robotic 
navigation  environments  which  can  reasonably  simulate  multistory  building  floorplans 
(where  the  robot  takes  elevators  to  teach  different  floors)  m:  simple  modelling  of  large  scale 
outdoor  terrain. 
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CHAPTER  2 
Background 


The  navigation  problem  can  be  viewed  as  a  search  for  a  patii  current  location 

to  a  goal)  through  an  environment  which  contains  obstacles.  There  are  many  different 
procedures  that  have  been  developed  to  solve  these  'search'  problems.  Some  procedures 
focus  on  finding  feasible  paths,  while  more  complicated  methods  concentrate  on  finding 
optimal  (i.e.  shortest  distance,  least  energy,  etc.)  paths.  Implementation  of  these 
procedures  is  normally  through  the  use  of  Artificial  Intelligence  (AI)  software  programs  on 
sequential  computers.  In  recent  years,  alternative  methods,  derived  fixwn  the  smdy  of 
biological  nemal  networks  have  been  exanuned.  These  networks,  although  structurally 
very  different,  can  provide  results  which  closely  resemble  the  good,  and  some  times 
optimal,  solution  path  AI  methods. 

Traditional  Search  Algorithms  Approach 

Basic  Artificial  Intelligence  search  procedures  used  to  find  feasible,  and  sometimes 
good,  paths  include  Depth-first,  Breadth-first,  Ifill  climbing.  Beam,  and  Best-first 
searches.  [See  Rich  (1983),  pp,  71-107,  and  Winston  (1984),  pp.  87-100.]  These 
methods  can  be  used  when  the  length/  cost  of  the  discovered  path  is  not  critical.  The 
procedures  follow  specific  algorithms  to  systematically  search  for  a  path  from  a  start 
position  to  a  goal  position.  Figure  3  is  an  example  'tree'-like  roadmap  through  the  space  of 
possibilities  for  the  'maze'-type  problem.  As  can  be  seen,  from  any  given  node  there  are 
four  (for  this  example)  children  nodes/  possible  moves  (to  its  right).  From  any  given  child 
node  there  are  again  four  follow-on  moves  that  can  be  made.  The  basic  search  procedures 
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listed  above  use  different  algorithms,  but  all  result  in  the  determination  of  a  complete  patii 
from  designated  start  to  goal  positions.  For  each  method,  if  a  solution  exists,  it  will  be 
found.  However,  there  is  no  guarantee  that  it  is  the  shortest/  optimal  path.  These 
procedures  will  also  vary  in  the  amount  of  tim^  wasted  steps  taken  before  a  feasible  path  is 
found. 


Some-  Possible  Later  Moves 


Figure  3 

Diagram  of  Expansion  of  Potential  Moves  for  Search  Algorithms 


To  aid  in  understanding  these  search  procedures,  the  Breadth-first  algorithm  will  be 
explained  in  greater  detail.  The  basic  algorithm  is  shown  in  pseudo-code  below: 


To  conduct  a  Breadth-first  search:  [Winston  (1984),  pp.  95] 

1 .  Form  a  one-element  queue  consisting  of  the  start  node. 

2 .  Until  the  queue  is  empty  or  the  goal  has  is  reached, 
determine  if  the  first  element  in  the  queue  is  the  goal  node. 

2a.  If  the  first  element  is  the  go^  node,  do  nothing. 

2b.  If  the  first  element  is  not  &e  goal  node,  remove  the 

first  element  from  the  queue  and  add  the  first  element's 
children,  if  any,  to  the  back  of  the  queue. 

If  the  goal  has  been  found,  armounce  success;  oth^wise  announce  failure. 


3. 
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Breadth-&st  search  lcx)ks  for  the  goal  node  among  all  the  nodes  at  a  given  level  (equal 
number  of  steps  from  the  start  node)  before  using  the  'children'  of  those  nodes  to  push  on. 
The  procedure  would  then  move  on,  level  by  level,  until  the  goal  is  found,  or  no  more 
moves  are  possible. 

Procedures  used  to  solve  for  optimal  paths  include  Random-Exhaustive-Search 
(British  Museum),  Branch-and-Bound,  E>ynamic  programming,  and  the  A*  search 
methods.  [Winston  (1984),  pp.  101-113,  Rich  (1983),  pp.  73-86]  These  procedures  are 
utilized  when  it  is  iir^wrtant  to  minimize  die  length  (or  cost  function)  of  the  path.  The 
Random-Exhaustive-Search  approach  finds  all  possible  paths  and  then  selects  the  best  one; 
therefore,  it  is  a  very  computationally  e}q)ensive  method.  The  A*  procedure  is  designed  to 
work  efficiently,  that  is  to  say  that  it  discovers  an  optimal  path  while  expending  nainimum 
effort  in  finding  the  path.  The  A*  search  is  much  more  efficient  than  the  Random- 
Exhaustive-Search  method  and  is  really  a  combination  of  the  two  otiier  mentioned  optimal- 
path  search  procedures  (Branch-and-Bound  and  Dynamic  progranoming).  The  A* 
algorithm  is  shown  in  pseudo-code  below: 


To  do  A*  search  with  lower-bound  estimates:  piston  (1984),  pp.  1 13] 

1.  Form  a  queue  of  partial  paths.  Let  the  initial  queue  consist  of  the 
zero-length,  zero-step  path  from  the  start  node  to  nowhere. 

2.  Until  the  queue  is  errq}^  or  the  goal  has  is  reached, 
determine  if  the  first  paA  in  the  queue  reaches  the  goal  node. 

2a.  If  the  first  pa&  reaches  the  goal  node,  do  nothing. 

2b.  If  the  first  path  does  not  reach  the  goal  node: 

2bl.  Remove  the  first  path  firom  the  queue. 

2b2.  Form  new  paths  from  the  removed  path  by  extending 
one  step. 

2b3.  Add  the  new  paths  to  the  queue. 

2b4.  Son  the  queue  by  the  sum  of  the  cost  accumulated  so  far 

and  a  lower-bound  estimate  of  the  remaining,  with  least-cost 
paths  in  fiont 

2bS.  If  two  or  more  paths  reach  a  common  node,  delete  all  tiiose 
paths  except  for  the  one  that  reaches  the  common  node  with  the  minimum  distaitee/  cost 

3 .  If  the  goal  has  been  found,  armounce  success;  othmvise  atmounce  failure. 
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A*  pursues  the  most-likely  shortest  path  by  &st  checking  all  of  the  nodes  that  immediately 
follow  the  start  node  and  creating  a  prioritized  queue  based  on  an  estimated  total  distance  to 
the  goal  node.  Then  it  takes  the  (assumed)  best  partial  path  and  creates  new  path 
extensions  based  on  its  new  state.  A*  then  resorts  the  queue  of  partial  paths  with  least  cost 
paths  in  front  (For  extra  efficiency.  A*  also  removes  redundant  /  inefficient  partial  paths 
which  lead  to  the  same  node  in  the  queue.)  These  checks  continue  as  A*  compares  the 
lengths  of  the  paths  (ie.  the  total  known  distance  travelled  plus  the  estimated  distance 
remaining)  and  moves  along  the  shortest  path  to  the  goal.  Note:  1)  A*  will  find  the 
optimal  path  if  the  'estimated'  distance  remaining  to  the  goal  is  a  lower  bound  on  the  actual 
distance.  2)  A*  wastes  time  when  it  checks  potential  paths  that  result  in  dead  ends.  3) 

The  performance  of  A*  is  dependent  upon  using  reasonably  accurate  estimated  distances 
between  nodes.  4)  The  Random-Exhaustive-Search's  disadvantage,  as  stated  earlier,  is 
that  it  is  very  computation/ time-consuming. 


Summary  of  AI  search  procedures:  [paraphrased  from  Winston  (1984),  pp.  131] 

Depth-first  and  Breadth-first  search  are  the  simplest  procedures.  Both  may  be 
considerably  less  efficient  relative  to  more  'informed'/  heuristic  based  procedures. 

Hill  climbing  is  a  more  informed  procedure  that  explores  'tree'  branches  in  the 
order  of  their  heuristically  guessed  plausibility.  Hill  climbing  shares  a  problem 
with  its  cousin,  Depth-fint  search,  in  that  a  wrong  decision  early  on  can  lead  to 
useless  wandering  later.  Hill  climbing  can  also  run  into  trouble  if  local  maxima 
exist  in  the  problem  environment 

Beam  search  is  a  modification  of  Breadth-first  search  in  which  only  the  best  nodes 
at  any  level  are  retained  for  further  search.  Beam  search  may  fail  to  find  legitimate 
paths. 

Best-first  searches  push  forward  from  the  most  promising  open  node  yet 
encountered. 

Branch-and-Bound  search  is  a  fundamental  procedure  for  finding  optimal  paths. 
The  basic  idea  is  to  extend  the  developing  'tree'  fix)m  tiie  end  of  tiie  least  costly 
partial  path.  Branch-and-Bound  search  is  often  m^roved  through  the  use  of 
estimates  of  distances  remaining  to  the  goal  and  by  eliminating  n^undant  paths  to 
intermediate  nodes,  thereby  becoming  A*. 
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Several  recent  papers  are  included  in  the  bibliography  which  concern  topics  which 
relate  to  path  planning  using  variations  of  the  traditional  search  methods.  Regalbuto  (1990) 
uses  the  A*  algorithm  as  part  of  a  control  system  for  a  mobile  robot  designed  to  help  the 
severely  handicapped.  Mitchell  (1988)  reviews  several  methods  for  optimal  path  planning 
(including  A*)  combined  with  computational  geometry  terrain  analysis  techniques. 
Badreddin  (1990)  use  a  Best-first  algmithm  in  combination  with  a  geometrical  and  logical 
model  of  the  environment  and  an  associative  memory  for  storing  the  paths.  Tilove  (1990) 
experimented  with  the  Eill  climbing  search  algorithm  as  part  of  a  mobile  robot  local 
obstacle  avoidance  system  based  on  the  method  of  potential  fields. 

A  Neural  Network  Approach 

An  interesting  alternative  to  the  traditional  AI  search  techniques,  all  of  which  require 
large  computational  efforts  on  sequential  computers,  is  the  use  of  a  customized  artificial 
neural  networks.  The  reference  to  neural  networks  comes  fiom  the  study  of  biological 
neural  networks  such  as  the  human  brain/  nervous  system. 

Due  to  billions  of  highly  intercoimected  neurons,  the  human  brain  is  capable  of 
solving  complex  problems,  such  as  pattern  recognition,  very  quickly.  Many  such  tasks  are 
still  beyond  the  capabilities  of  our  best  algorithms  even  when  implemented  on  the  fastest 
supercomputers.  The  key  difference  is  the  use  of  a  large  number  of  sinqjle  processing 
element^  (neurons)  in  parallel  as  opposed  to  a  single  complex  central  processing  unit 
(CPU)  handling  information  in  a  sequential  maimer.  It  should  be  made  clear  that  no  current 
artificial  neural  networks  even  slightly  approach  the  complexities  of  the  human  teain, 
however  significant  advances  in  perception,  cognititm,  and  adaptation  have  been  made  by 
exploiting  some  of  the  features  of  the  biological  networks. 

The  basic  building  block  of  a  laologicai  neural  network  is  the  neuron.  A  neuron  is 
a  cell  in  the  nervous  system  witii  the  special  characteristics  of  electro-chemical  excitability. 
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Due  to  this  excitability,  the  cell  is  able  to  conduct  and  process  information.  Figure  4  shows 
a  sketch  of  a  typical  biological  neuron,  with  key  components  labeled. 


Main  components  of  a  neuron  are:  [See  Wasserman  (1989),  Appdx.  A,  and  Mead  (1989), 
Chap.  4,  for  further  details.] 

Synapses:  junctions  which  form  (usually)  between  the  terminals  of  an  axon  and 
the  dendrites  of  other  neurons.  They  allow  passage  of  information/  signals  between 
cells. 

Dendrites:  'tree'-like  extensions/  processes,  which  receive  signals  firom  other 
cells  at  junction/  cormection  points  called  synapses. 

Cell  body:  essentially  averages  the  various  signals  received  by  the  dendrites,  thus 
detmruning  the  cells  excitation  level  (if  the  sig^  average  over  a  short  time  interval 
is  sufficiently  large,  the  cell  ’fires'). 

Axon:  when  the  cell  'fires',  a  pulse  is  produced  down  its  axon  that  is  passed  as 
signals  to  succeeding  cells. 

Note  that  hundreds  of  neuron  'types'  have  been  identified,  each  with  a  distinctively  shaped 
cell  body  and  found  to  exhibit  in^rtant  fimcticmal  specializations. 
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The  information  processing  in  the  brain  consists  of  a  combination  of  chemical 
signals  sent  across  the  synapses  and  electrical  signals  within  the  neuron.  It  is  the  con:q)lex 
action  of  the  cell  membrane  that  creates  the  cell's  ability  to  produce  and  transmit  both  kinds 
of  signals.  Note  that  the  'firing  rate'  of  a  neuron  is  determined  by  the  cumulative  effect  of  a 
large  number  of  excitatory  and  inhibitory  inputs,  roughly  averaged  by  the  cell  body  over  a 
short  time  interval.  In  this  way,  the  neuron  signal  is  'pulse-rate'  or  frequency  modulated. 


Figure  5  shows  a  model  of  an  artifrcial  neuron.  This  model  was  designed  to  mimic 
the  first-order  characteristics  of  the  biological  neuron  and  is  typical  of  the  type  currently 
being  used  in  most  neural  network  research.  This  sample  neuron  (Node  j)  has  several 
inputs  (Xij)  with  associated  weights  (Wij),  a  fixed  threshold  (©),  and  an  output  (Yj) 

(which  may  even  reverberate  back  to  Node  j).  Note  that  the  function  (fct)  which  is  applied 
to  the  sum  of  the  inputs  multiplied  by  their  weights  and  then  modified  by  subtracting  the 
threshold  is  normally  a  non-linearity  function.  Early/  simpler  models  often  used  tiie  'sign' 
function  (hard-limiter)  shown  below; 
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sign  function  * 

(Ifard-Limiter) 

e  ^ 

For  discrete  time  (and  assuming  the  'sign*  non-linear  function)  the  neuron  model's  output 
can  be  described  mathemadcally  as: 


Yj(t+At)=Sgil 


m 


IwyXi(t)-ej 


Other  non-linearity  functions,  such  as  and  the  sigmoid/  logistics  function  (which  allows  a 
range  between  0  and  1),  are  used  more  often  now  due  to  improved  modelling 
characteristics  and  continuous  differentiability. 


Figure  6 

An  Electrical  (Circuit  Neurcm  Model 


An  electrical  circuit  model  for  a  basic  (additive  subclass)  neurcHi  is  shown  in  Figure 
6.  It  can  be  mathematically  described  by  tile  following  equation:  [ref:  Ogmen(1989)] 
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So  far  the  neural  network  background  review  has  covered  a  single  neuron. 
Although  understanding  a  neuron’s  function  is  very  important,  the  'power'  of  neural 
networks  comes  fix)m  their  parallel/  highly-interconnected  structure,  memory,  and  learning/ 
adapting  capabilities.  While  the  intercormected  stracture  is  visually  obvious,  the  memory 
of  a  network  is  hidden  in  the  values  of  the  connection  weights  and  thresholds.  No 
individual  neuron  is  used  to  store  a  complete  'single-memory',  rather  the  network  as  a 
whole  responds  to  its  input  by  producing  a  global  (across  the  netwo±)  response  based  on 
all  stored  connection  weights  and  threshold  values.  Learning  by  the  network  involves 
modifying  these  weights  and  thresholds  to  adapt  the  response  to  given  input(s).  An 
example  of  a  simple  binary  network  which  has  been  trained/  taught  to  solve  the  classic 
EXclusive-OR  logic  function  is  shown  in  Figure  7.  The  connection  weights  and  neuron 
thresholds  have  already  been  set-appropriately,  based  on  the  input  versus  the  desired  output 
set.  (Here  the  nodal  non-linearity  function  consist  of  outputing  a  0  or  1,  depending  on  the 
False  or  True  result  of  the  threshold  inequality,  respectively.) 


XOR  Table 


Input  1 

Output 

Lil 

In2 

Out 

0 

0 

0 

0 

1 

1 

1 

0 

1 

1 

1 

0 

Figure  7 

Binary  Neural  Netwo±  Taught  to  Perform  EXclusive-OR  Function 
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Several  recent  papers  are  included  in  the  bibliogr^hy  which  concern  topics  relevant 
to  using  artificial  neural  networks  for  navigation.  Norwood  (1989)  uses  an  neural-type 
network  to  create  potential  fields  as  part  of  a  robotic  path  planning/  obstacle  avoidance 
system.  Hopjfield  (1985)  uses  recurrent  networks  to  solve  the  classic  Traveling  Salesman 
Problem'  (results  are  not  guaranteed  to  be  optimal,  yet  'good'  solutions  are  reached  rapidly 
for  even  very  con^lex  cases).  Badreddin  (1990)  uses  an  associative  memory  (often 
implemented  as  neural  networks)  to  store  available  paths  in  connection  with  a  geometrical 
and  logical  environmental  modelling  scheme.  Hutchinson  (1988)  uses  a  combination 
analog/  binary  resistive  network  for  computing  optical  flow  as  part  of  a  biological  early 
vision  model. 
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CHAPTER  3 

Hybrid  Network  System  for  Navigation 


As  stated  earlier,  a  goal  of  this  research  project  is  to  design  and  build  an  electronic 
connectionist  network  system  which  will  solve  a  specific  two-dimensional  maze-type 
navigation  problem.  To  solve  this  problem  a  hybrid  system  was  designed  which  contains 
two  separate  and  very  different  network  stmctures  brought  together  with  a  supervisory/ 
control  system.  The  first  network  processes  the  environmental  sensory  input  using  a 
binary  input/  analog  output  resistive  'coimectionist'  network.  The  ou^ut  of  the 
connectionist  network  is  repeatedly  analyzed  by  the  second  network,  a  small  feed-forward 
analog  input/  binary  ou^ut  network,  which  determines  the  local  path  moves. 

Sensory  Analysis  Connectionist  Network 


Connectionist 

Network 

Grid 

Pattern 


I  sample  node  (ij)  I 


Figure  8 

Connectionist  Network  Structure 
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The  first  network  consists  of  a  seven-by-seven  grid  of  simple  processing  'nodes'  as 
shown  in  Figure  8.  Each  node  is  connected  to  its  four  nearest  neighbors  and  receives 
external  input  setting  it  as  one  of  the  four  Qrpes  mentioned  earlier  (obstacle,  free  space, 
goal,  or  start).  A  sample  neighborhood  for  the  sample  Node  ij  is  shown  in  Figure  9.  The 
inputs  to  this  network  designate  each  node  as  either  obstacle,  free  space,  goal,  or  start. 


A  computationally  convenient  choice  for  the  input  is  by  way  of  two  seven-by-seven 
matrices.  Matrix  M  (Maze  Mask  Matrix)  contains  elements  which  are  set  0  if  the  node  is 
an  obstacle  and  a  1  if  it  is  a  free  space,  goal,  or  start  The  second  matrix,  F  (Forced  Nodes 
Matrix)  contains  tri-state  elements.  A  goal  node  is  represented  by  a  1,  the  stan  and  obstacle 
nodes  are  represented  by  a  -1,  and  free  space  nodes  are  represented  by  a  0.  The  network's 
output  is  represented  by  an  analog  seven-by-seven  matrix  V.  Elements  of  V  range 
anywhere  between  -1  and  1.  V  represents  an  'energy  potential'  map  of  the  maze.  The 
values  of  forced  nodes  are  known  'up-front',  however  a  free  space  node's  output  is  the 
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average  of  the  outputs  of  its  four  nearest  neighbors  which  are  non-obstacle  or  non¬ 
boundary  region.  Optionally,  matrix  VSE,  which  is  equivalent  to  V  except  that  the  range 
of  its  elements  are  GND  (0)  to  VCC,  provides  network  output  using  the  same  scale  as  the 
electronic  implementation.  Based  on  the  r  oove  input  definitions  we  can  analyze  the  output 
for  any  given  Node  i  j  (at  row  i,  column  j).  The  possible  outputs  are: 


Goal 

Vij  =  1  (VCC  for  electronic  implementation) 
Start  /  Obstacle 

Vij  =  .l  (GND,  0  for  electronic  implementation) 
Free  Space 

1 

neighbors 

~1  Mi, 

ndghbors 


where  neighbors  (k,l)  are  the  four  nearest  nodes: 
(i-l,j)  up 
(i,j+l)  right 
(i+l,j)  down 
(i,j-l)  left 

Note:  If  a  free  space  node  is  surrounded  by  four  obstacle  nodes,  this  equation 
would  result  in  division  by  zero.  This  can  be  corrected  with  a  condition^  test 
where  if  S  Mfci  =  0,  then  arbitrarily  set  Vh  =  -1.  This  does  not  cause  a  problem 
for  the  electronic  implementation,  since  such  a  node  (which  would  have  a  'floating' 
value)  would  never  be  reached  by  the  solution  path. 


A  'General  Node  Output  Equation'  can  be  represented  by:  (see  Note  above) 


v..= 


I  Vfc.Mk, 


neighbors 


X  M 


neighbon 


kl 


1  ‘  (Fij)^ 


+  F 


U 
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An  examination  of  the  general  output  equation  makes  it  clear  that  computing  the  output  for 
this  network  consists  of  solving  forty-nine  simultaneous  linear  equations  of  up  to  forty- 
seven  unknowns  (assuming  the  case  where  there  is  one  goal,  one  start  node  and  no 
obstacles).  The  solution  will  take  some  time  on  a  digital  computer,  however  it  is  almost 
instantaneous  on  the  parallel  processing  network.  For  the  optional  output  matrix  VSE,  the 
General  Node  Output  Equation  (to  simulate  the  electronic  implementation)  can  be  described 
by;  (see  Note  above) 


S  Vk.Mk, 

neighbors 

S  Mfc, 

neighbors 


Vcc 

2 


Vcc  is  the  source/  supply  voltage  for  the  electronic  implementation. 


Local-Move-Finder  Network 


V[i-lo] 

V[i,j+1] 

V[i+ij] 

V[ij-1] 


Input  HSdden  Layer  Output 


North 

East 

South 

West 


Figure  10 

Local-Move-Finder  Netwo±  Structure 
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The  second  network  consists  of  a  three-layer  feed-forward  system  with  fourteen 
nodes  (4  input,  6  hidden,  and  4  output).  In  the  input  layer,  four  nodes  receive  analog 
inputs  from  the  previous  network  through  a  control  circuit  which  selects  the  four  neighbor 
node  outputs  for  any  'given'  current  location.  The  network  processes  the  input  through  six 
hidden  nodes  and  the  four  output  nodes  provide  the  information  as  to  the  'best'  move 
direction  from  the  current  position  (a  'winner-take-all'  binary  output  signal).  Figure  10 
shows  the  stmcture  for  this  network. 


Figure  11 

Local-Move-Finder  Network  Sample  Nodes 


Figure  1 1  shows  a  sample  node  from  each  layer  of  this  network.  General  output 
equations  for  the  nodes  of  each  layer  can  now  be  derived.  The  Input  Layer  (node  1)  is 
purely  a  distribution  layer,  tatting  its  analog  input  signal  and  channeling  it  to  three 
destination  nodes  of  the  second  (hidden)  layer.  Each  Hidden  Layer  Node  (example  node 
m)  receives  two  inputs:  IHml  and  IHin2.  Each  input  is  multiplied  by  its  appropriate 
weight  ,Wml  or  Wtn2,  and  these  values  are  then  summed.  We  subtract  the  threshold 
value,  ThresHfai,  from  the  input  sum  and  then  apply  the  sign  (Non-Linearity)  function  to 
this  value.  Thus  if  the  value  is  negative,  the  output  from  the  Hidden  Layer  would  be 
HOUTm  =  -1;  if  the  value  is  positive,  the  output  would  be  HOUTm  =  +1.  For  this 
particular  application,  set  Wml  =  +1,  Wm2  =  -1,  and  ThresHm  =  0.  This  results  in  a 


21 


simple  comparator  node,  where  the  output  is  'high'  if  the  first  input  value  is  greater  than  the 
second  and  'low'  if  the  first  input  is  less  than  the  second.  Thus  the  output  fi-om  a  Hidden 
Node  can  be  described  by: 

HOUTm  =  SGN[Z(IHmi)(Wmi)  -  ThresHm]  =  S(  -NLIHml  -  IHm2] 
i=l,2 

where  ThresHm  =  0 
Wml=+1 
Wm2=  -1 


In  the  Output  Layer,  each  node  (example  node  n)  receives  three  inputs:  OHnl, 
OHn2andOHn3.  Each  input  is  multiplied  by  its  appropriate  weight:  Znl,  Zn2orZn3, 
These  values  are  then  summed.  Next,  the  threshold  value,  ThresOn,  is  subtracted  from  the 
input  sum  and  finally  the  sign  (Non-Linearity)  function  is  applied  to  this  value.  Thus  if  the 
value  is  negative,  the  output  fi:om  the  Output  Layer  would  be  OUTn  =  -1;  if  the  value  is 
positive,  the  output  would  be  OUTn  =  +1.  For  this  particular  network,  set  ThresOn  =  2.5 
and  the  three  weights  appropriately  to  +/- 1  to  mateh  the  three-input  AND  gates  of  Module 
4  in  Appendix  A  (-1  for  AND  inputs  with  inverters).  Thus,  the  Output  Layer's  nodes 
output  become: 


OUTn  =  SGN[XaOni)(Zni)  -  ThresOn] 


i=l,Z3 


where  ThresOn  =  2.5 
Znl=+/-1 
Zn2  =  +/-1 
Zn3=4-/-1 


And  individually: 

OUTi  =  SGN[  lOil  +  IOi2  + 1013  -  2.5] 
0UT2  =  SGN[  - 1021  + 1022  + 1023  -  2.5] 
OUT3  =  SGN[  -  IO31  -  IO32  +  IO33  -  2.5] 
OUT4  =  SGN[  -  IO41  -  IO42  -  IO43  -  2.5] 
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CHAPTER  4 

Hardware  Implementation  of  Hybrid  System 


Chapter  3  covered  the  theory  behind  the  two  network  architectures  proposed  for  use 
in  navigation  control.  This  chapter  covers  the  actual  implementation  of  the  hybrid  system 
using  electronic  hardware.  The  resulting  device  was  named  the  'Maze  Machine'.  It 
consists  not  only  of  the  two  networks,  but  also  the  accessory  electronic  interface  circuitry 
(required  for  a  simple  stand-alone  system)  needed  to  provide  the  inputs,  multiplexing, 
control,  and  path  display  of  solutions . 


The  Maze  Machine 
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solving  the  seven-by-seven  grid  'maze'  problems  explained  earlier.  The  device  was 
constructed  using  six  'modules'  that,  when  properly  inter-connected,  make  up  the  Maze 
Machine.  Figure  13  shows  a  block  diagram  of  the  layout  and  information  exchange 
characteristics  of  the  system  modules. 


Figure  13 

Block  Diagram  of  Electronic  Hybrid  System 


For  detailed  graphical  views  of  the  individual  modules  see  Appendix  A,  Maze 
Machine  Electronic  Module  Diagrams.  For  module/  IC  chip  wiring/  connection  information 
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see  Appendix  B,  Maze  Machine  Module  Wiring  Tables.  For  a  parts  inventory  and 
assembly  notes  see  Appendix  C,  Maze  Machine  Tools/  Parts  Required.  What  follows  is  a 
module  by  module  description  of  the  design  and  operation  of  the  Maze  Machine: 

Module  1  -  Input)  This  is  the  input  block  (hand-placed  electrically-wired 
plugs  which  fit  into  sockets  of  Module  2).  Four  kinds  of  plugs  are  used  to  represent  the 
four  possible  conditions  of  a  node:  obstacle,  free  space,  goal  or  start  The  particulars  for 
each  of  the  four  node  types  are:  1)  for  an  obstacle  node  (and  also  the  outer  boundary), 
force  the  node  voltage  output  to  GND  and  disconnect  its  resistor  connection  links  to  its 
neighbors,  2)  for  a  free  space  node,  allow  the  node  voltage  output  to  'settle'  on  the 
average  value  of  the  neighbor  nodes  influencing  it  (while  also  allowing  its  output  to 
influence  its  neighbors,  i.e.  recurrent  behavior),  3)  for  the  goal  node,  force  the  node 
voltage  output  to  VCC  (soured  supply  voltage)  and  allow  it  to  influence  its  neighboring 
nodes,  and  4)  for  the  start  node,  force  the  node  voltage  output  to  GND  and  allow  it  to 
influence  its  neighboring  nodes,  (user  controlled  binary  data)  (see  Appendix  A,  Figure  Al) 
Module  2  -  Connectionist  Network)  This  network  consists  of  49  wired 
sockets  interconnected  by  100  kfli  resistors.  These  nodes  receive  binary  inputs  through  the 
input  plugs  and  the  nodes  provide  appropriate  output  'voltage  potentials'  (analog)  derived 
as  a  function  of  the  various  external  inputs  and  the  interconnecdons  between  neighboring 
nodes.  Note  that  no  pins  within  a  node  socket  are  connected  to  each  other  until  one  of  the 
four  plugs  of  Module  1  is  inserted,  (binary  to  analog)  (see  Appendix  A,  Figure  A2  &  A3) 
Module  3  -  Multiplexer)  This  module  is  a  multiplexing  circuit  which 
receives  the  49  analog  'voltage  potentials'  from  Module  2  and  the  current  binary  coded 
decimal  (BCD)  location  address  (representing  the  robot's  position  in  the  maze)  fijom  the 
Move  Control  Module.  The  module's  ouq)ut  consists  of  five  lines.  The  first  four  lines 
carry  the  'voltage  potentials'  of  the  four  nearest  neighbors  of  the  current  node  to  the  Local- 
Move-Finder  Network,  Module  4.  The  fifth  line  provides  the  current  node's  'voltage 
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potential'  as  a  separate  (external)  output  for  test  verification  and  review,  (analog+binary  to 
analog)  (see  Appendix  A,  Figure  A4  &  A5) 

Module  4  -  Local-Move-Finder  Network)  This  network  takes  the  four 
analog  'voltage  potentials'  fix)m  the  Multiplexer,  Module  3,  and  provides  as  its  output  four 
binary  lines  which  teU  the  Move  Control  Module  and  the  user  which  direction,  of  the  four 
possibilities,  shows  the  greatest  voltage  increase  and  is  thereby  the  'best'  move  (locally). 
As  with  the  network  design,  the  comparison  is  internally  done  in  parallel  for  speed 
advantages,  (analog  to  binary)  (see  Appendix  A,  Figure  A6) 

Module  5  -  Move  Control)  This  module  provides  the  cycle  control  which 
steps  the  machine  through  the  navigation  solution  path,  one  step/  move  at  a  time,  by 
providing  the  appropriate  current  location  address  to  the  Multiplexer  Module  and  updating 
the  current  location,  as  required,  based  on  the  Local-Move-Finder  Network  Module's 
output.  This  module  can  be  provided  with  manual/  user  controlled  external  inputs  for 
setting  the  current  address  to  any  desired  value  for  running  special  tests  (see  Appendix  D, 
Procedure  for  Ruiuting  Maze  Machine  Auto-Path  Test).  This  circuit  also  sends  the  current 
address  to  the  Path  Output  Display  Module,  (binary)  (see  Appendix  A,  Figure  A7) 
Module  6  -  Path  Output  Display)  This  module  contains  multiplexing 
circuitry  and  49  RS  flip-flops,  one  per  node.  It  controls  an  array  of  49  LEDs  which 
display  the  solution  path  (and  the  intermediate  moves  as  the  path  is  being  generated), 
(binary)  (see  Appendix  A,  Figure  A8) 

Note:  The  plugs  and  sockets  of  Modules  1  and  2  are  an  awkward  system  used  for  its 
relative  simplicity  and  low  cost.  Figure  A9,  Appendix  A,  shows  an  alternative  which 
replaces  the  plug  and  socket  nodes  with  a  set  of  wired  IC  chips  (3  off-the-shelf  CMOS 
chips  required  per  node).  These  nodes  would  be  controlled  through  flip-flop  memory 
which  could  be  quickly  initialized  with  test  input  data  using  a  serial  computer  interface. 
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Maze  Machine  Results 


Key: 


Optional  Path  1 
(17  moves) 


Optional  Path  2 
(13  moves) 


Optional  Path  3 
(11  moves) 
(Shortest!) 


Figure  14 

Sample  Maze  Machine  Test  Problem  Analysis 


The  Maze  Machine  was  tested  using  a  variety  of  sample  'mazes'/  path  planning  and 
obstacle  avoidance  problems.  The  machine  consistendy  provided  good  (often  optimal) 
solutions  based  on  the  environment  and  assumptions  imposed.  Figure  14  shows  a  typical 
test  'maze',  along  with  all  possible  solution  paths. 
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Voltage  Potential  Table  for  Maze  Machine  Sample  Test  Problem 
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Table  1  shows  the  nodal  voltage  potentials  for  this  problem.  The  solution  path  is 
highlighted  in  bold  print.  (Reference  Appendix  E,  Maze  Machine  Test  Data  and  Results, 
Test  4  -Table  E6.)  The  path  selected  by  the  Maze  Machine  for  this  particular  test  was 
Option  Path  3  (which  was  shortest/  optimal). 

In  the  lests  ran,  the  environment  defined  usually  contained  more  than  one  feasible 
path  (fiem  start  to  goal).  After  setting  the  environment  (by  defining  start,  goal,  free  space, 
and  obstacle  nodes),  voltage  readings  were  taken  for  each  node.  As  expected:  1)  an 
obstacle  had  a  voltage  output  of  GND/  0  volts  (note  that  the  boundaries  were  treated  as 
obstacles),  2)  the  start  point  also  had  an  output  of  GND/  0  volts  (it  differed  from  obstacles 
in  that  the  start  point  outputs  its  'forced*  voltage  to  its  neighbors),  3)  the  goal  was  set/ 
'forced'  to  source  voltage,  VCC/  approximately  12  volts,  and  4)  the  free  spaces  had 
voltage  readings  ranging  from  GND  to  VCC  volts.  Next,  the  path  was  determined  step-by- 
step,  beginning  at  the  start  node.  For  each  move,  the  voltage  difference  between  the 
'current'  node  and  its  four  neighbors  (i.e.  north,  east,  south,  west)  was  analyzed.  The  best 
(local)  move  was  selected  as  being  in  the  direction  of  the  greatest  voltage  increase.  By 
following  the  path  of  greatest  local  voltage  increase,  the  path  that  the  Maze  Machine  would 
select  could  be  determined. 

After  sampling  the  voltage  outputs,  each  actual  test  was  run  on  the  Maze  Machine. 
As  stated  earlier,  in  each  case,  the  machine  successfully  navigated  the  maze  and  avoided 
obstacles  while  selecting  a  good  (best,  from  a  local  voltage  increase  basis)  path.  The  path 
selected  was  indeed  the  same  path  that  was  found  by  following  the  path  of  greatest  local 
voltage  increase  fixjm  the  recorded  voltage  potential  table.  This  electronic  hybrid  network 
system  successfully  solved  the  two-dimensional  navigation  problems  that  were  presented. 
See  Appendix  E  for  the  nodal  voltage  potentials  and  the  machine's  results  for  several 
sample  mazes/  tests. 


Chapter  5 

Software  Simulation  of  Hybrid  System 
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The  design  and  construction  of  the  Maze  Machine  was  the  first  phase  of  this 
research  project.  This  device  successfully  demonstrated  the  real-time  navigation  control 
capability  of  the  described  hybrid  network  system.  The  plan  now  called  for  1)  going 
beyond  the  seven-by-seven  grid  limitation,  2)  allowing  an  option  of  eight  possible 
horizontal  moves  firom  a  given  node  (thus  allowing  the  robot  diagonal  travel),  and  3) 
allowing  option  of  vertical  (3D)  movement  (such  as  travel  up  and  down  a  building's 
elevator).  To  build  a  reasonably  sized  system  in  hardware  would  likely  require  extensive 
use  of  custom  analog  VLSI  technology.  Rather  than  expend  this  large  effort/  cost,  the 
second  phase  of  research  consisted  of  writing  a  software  program  which  could  simulate  the 
output  characteristics  of  the  parallel-architecture  Maze  Machine,  while  also  permitting  the 
extended  capabilities  mentioned  above. 

It  should  be  made  clear  that  this  chapter  describes  a  simulation  for  the  desired 
system.  A  main  advantage  mentioned  earlier,  that  of  real-time  control,  is  lost  due  to  the 
serial/  iterative  processing  required  for  such  a  software  based  system.  Note  that  the  Maze 
Machine's  connectionist  network  almost  instantly  'settles'  on  stable  nodal  voltage  potential 
outputs  (no  matter  what  the  size  of  the  grid  environment,  2D  or  3D),  while  the  software 
program  must  process/  compute  a  large  number  of  simultaneous  linear  equations  (i.e.  49 
equations  of  up  to  47  unknowns  for  the  7-by-7  grid  problems)  in  an  iterative  fashion. 

Thus  the  software  solution  is  very  time  consuming  and  its  efficiency  is  highly  effected  by 
the  problem  complexity/  grid  size  being  analyzed,  the  memory  capacity,  and  speed  of  the 
computer/  CPU  being  used. 
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The  AMAZ3D  Program 

The  result  of  the  software  simulation  effort  is  a  program  named  AMAZ3D.  The 
source  code  was  written  in  FORTRAN??  and  has  been  successfully  compiled  and  run  on 
various  computer  systems  (Macintosh  PC,  SUN  workstation,  and  UNIX  based  network). 
The  main  program  AMAZ3D.f,  along  with  its  subroutines,  comprises  the  complete 
sequential  computer  simulation  for  the  hybrid  connectionist  network  system  used  for  path 
planning/  obstacle  avoidance.  Some  of  the  program's  organization  and  operation  show 
similarities  to  the  traditional  search  algorithms  mentioned  in  Chapter  2,  Background  (i.e. 
the  Local-Move-Finder  Network  has  been  replaced  by  a  Best-first  search  routine).  The 
outline  for  AMAZ3D  is  shown  in  pseudo-code  below: 


To  find  a  good  path  using  AMAZ3D: 

1 .  Enter  program  preferences. 

2 .  Input  problem  parameters,  environmental  data,  start  and  goal  positions. 
2a.  AUow  for  modification  of  parameters  and  problem  inputs. 

3 .  Initialize  nodal  array.  Set:  fi^e  space  =  GND  (initially), 

obstacles  =  GND, 
start  =  GND,  & 
goal  s=  VCC. 

4 .  Calculate  values  for  nodal  voltage  potentials  by  'setting' 
free  node  Vouts  to  average  of  non-obstacle  neighbors. 

4a.  Until  #  of  iterations  or  accuracy  is  reached,  return  to  4. 

5 .  Output  #  of  iterations  and  error  estimate. 

6 .  Initiate  PATH  with  current  node  position  =  start  position. 

?.  Calculate,  path: 

?a.  If  current  position  =  goal  position,  go  to  8. 

?b.  Determine  move  direction  (DIR), 

based  on  'best'  (local)  move  from  ciurent  position. 

?  b  1 .  If  no  volt  increase  move  exists,  announce  failure,  go  to  9. 

?c.  Update  PATH  with  new  current  position,  based  on  old  +  DIR. 

? d.  Update  path  length  info,  return  to  ?. 

8 .  Announce  success,  output  PATH/  Problem  Solution. 

9 .  Return  to  1.  or  exit  program. 


The  acmal  AMAZ3D  program  reads  in  three  data  files: 

1)  amaz3d.prf  [A  preferences  file  fon  a)  describing  the  screen  output  device 
number;  6  for  IBM  PCs/  SUN  workstations  and  9  for  the  Macintosh  PC 
and  b)  FILEDF,  the  default  file-name  for  tiie  assumed  input  parameter 
file.]. 
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2)  FILEDF  or  file-name  entered  by  user  [A  parameter  file  which  provides 

key  informadon  to  the  program.  All  parameters  but  the  sensory  data  file 
array  dimensions  and  FILEM,  the  initial  node  declarations  file,  can  be 
modified  later  by  the  user  within  the  AMAZ3D  program.], 

3)  FILEM  [Sensorydatamputfile,  name  provided  by  above  mentioned  parameter 

file,  which  provides  AMAZ3D  program  with  initial  environmental  sensory 
data  for  the  nodal  array  which  was  dimensioned  through  FILEDF  entries.]. 

Note:  In  the  software  program  it  is  convenient  to  enter  the  free  space  versus  obstacle 
environmental-data  as  an  array,  the  start  and  goal  node  positions  as  vectors,  and  several 
other  program  preferences  as  appropriate  variables. 

The  program  accomplishes  its  simulation  of  the  parallel  processing  connectionist 
network  by  starting  out  with  an  initial  unstable  network  output  state.  (Goal  node  set  to 
VCC,  all  other  nodes  initially  set  to  GND.  Note  that  obstacle  nodes  are  disconnected/ 
isolated  from  their  neighbors.)  Next  AMAZ3D  iteratively  updates/  refines  the  network 
towards  a  stable  output  array  state.  One  iteration  consists  of  resetting  each  free  node's  next 
state  to  the  average  value  of  its  'connected'  neighbor  nodes'  current  states.  In  this  way, 
after  numerous  iterations,  the  output  array  state  of  the  nodal  network  will  approach  a  stable 
value  (with  free  node  values  between  GND  and  VCC).  The  iteration  stop/  cut  off  can  be 
set  to  a  maximiun  number  of  iterations  or  to  a  maximum  allowable  single  iteration  nodal 
change  value. 

After  the  network  system  has  stabilized  (to  an  acceptable  degree),  other  subroutines 
(described  individually  in  Appendix  F)  are  used  to  determine  the  actual  path  by  using  a 
step-by-step  examination  of  the  current  position  node's  nearest  neighbors  and  selecting 
moves  which  follow  the  path  of  greatest  local  nodal  value  increase. 

Since  this  program  is  only  a  simulation  of  the  desired  parallel  processes  of  the  Maze 
Machine,  it  has  the  urtique  feature  of  being  able  to  provide  the  number  of  steps  for  (globally 
optimal)  minimum-distance  solutions  to  the  path  planning  problems  presented.  This  is 
accomplished  by  adding  a  step  to  the  iterating  process  which  checks  to  see  if  any  of  the 
start  node's  nearest  neighbors  have  been  disturbed  (i.e.  if  any  of  their  output  values  change 
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from  their  initial  GND  value).  If  a  disturbance  is  detected,  the  program  alerts  the  user  with 
the  current  number  of  iterations  and  presents  the  opportunity  to  stop  the  iterative  process 
and  move  directly  to  the  localized  path-finding  subroutines.  The  user-alert  occurs  at  the 
minimum  distance  number  of  steps  due  to  the  fixed  unit  grid  structure  of  the  connectionist 
network.  Since  all  inter-node  connections  are  assumed  to  be  of  equal  distance,  the 
'voltage'  disturbance  radiating  out  from  the  goal  will  travel  an  identical  distance  in  all 
allowable  directions  from  the  goal  for  any  given  number  of  iterations.  Therefore,  the 
shortest  distance  between  goal  and  stan  will  provide  the  earliest  disturbance  to  the  start 
node's  neighbors.  If  the  iteration  process  is  now  stopped,  the  network  will  not  have  a 
chance  to  'settle'  but  will  still  provide  a  good  path  solution.  (Note  that  the  actual  paths  are 
still  found  using  the  local  optimizer  routine  which  may  provide  non-optimal  global 
solutions  due  to  forks  in  the  potential  paths.)  This  extra  check  step  in  the  iteration  process 
can  be  described  as  a  Breadth-first  search  technique  (refer  back  to  Chapter  2,  p.  7  for 
pseudo-code)  which  has  been  conditioned  to  allow  only  equal  length  moves,  thereby 
making  the  first  path  length  detected  also  the  shortest  path  by  definition. 

Finally,  the  program  provides  subroutines  for  displaying  the  path  information  in 
two  formats:  1)  a  step-by-step  move  list,  which  provides  each  path  nodes'  grid  location 
along  with  the  direction  to  move  and  2)  a  printout  of  the  entire  nodal  environment  with  the 
path  steps  highlighted  by  numbers  counting  up  from  1  to  9,  then  a  0,  and  starting  again  at  1 
(this  count  cycle  is  used  to  minimize  the  size  of  the  output  printout,  while  still  keeping 
critical  information  about  move  direction),  (See  Appendix  F  for  AMAZ3D.f  source  code 
listing,  and  Appendix  G  for  sample  problem  outputs.) 

Note  that  to  keep  the  program  memory  requirements  reasonable  for  a 
microcomputer,  the  maximum  sized  sensory  data  input  file  has  bee.t  limited  to  a  three 
dimensional  array  of  80  rows  by  80  columns  by  8  layers  of  height  (which  requires 
approximately  1  Mbyte  RAM).  Tliese  values  are  arbitrary,  of  course,  and  can  be  changed 
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in  the  variable  declmtion  statements  of  the  program  source  code  before  compilation;  the 
only  limitation  is  memor>'  availability.  Also  note  that  two  types  of  obstacles  have  been 
allowed  for;  1)  'normal'  obstacles  are  set  to  GND  and  are  isolated  from  their  neighbors  in 
the  network  (i.e.  do  not  influence  the  neighbors'  nodal  value  outputs)  and  2)  'connected' 
obstacles  which  have  the  same  characteristics  as  the  start  node  (ic.  set  to  GND  but  left 
connected  to  the  network  so  that  their  influence  is  felt  by  the  neighboring  free  nodes).  This 
second  type  of  obstacle  node  allows  the  program  to  approximate  the  potential  fields 
approach  used  by  Norwood  (1989)  in  his  Master's  Thesis  on  Robotic  Path  Planning  and 
Obstacle  Avoidance:  A  Neural  Network  Approach.  Paths  created  using  the  connected 
obstacles  show  the  tendency  of  trying  to  'avoid'  the  obstacles  rather  than  'side-swipe'  them 
to  minimize  distance  travelled. 

AMAZ3D  Results 

The  AMAZ3D  program  was  tested  using  a  variety  of  sample  path  planning/  obstacle 
avoidance  problems.  The  software  simulation  system  consistently  provided  good  (often 
optional)  solutions  based  on  the  environment  and  ass  unptions  imposed. 
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Voltage  Potential  Table  for  AMAZ3D  Sample  Test  Problem 
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Table  2  shows  the  program's  final  nodal  voltage  potentials  for  the  same  test  maze  run  on 
the  Maze  Machine  and  shown  in  Hgure  14  of  Chapter  4.  (Also  see  Appendix  E,  Test  4  - 
Table  E6  for  complete  Maze  Machine  results,  and  Appendix  G,  maz.out,  for  complete 
AMAZ3D  printout)  The  program  was  allowed  to  iterate  through  371  cycles,  until  the 
maximum  individual  nodal  change  per  iteration  was  less  than  0.001. 

Note  that  the  solution  path  given  AMAZ3D  was  the  same  as  the  Maze  Machine.  Table  3 
shows  the  comparative  differences  between  the  nodal  voltage  potentials  of  the  Maze 
Machine  (see  Chapter  4,  Table  1)  and  AMAZ3D  for  the  sample  maze  of  Figure  4  (the 
numbers  in  the  table  represent  Vout  (AMa23D)  -  Vout  (Maze Machine) ). 
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Table  3 


Voltage  Potential  Difference  Table,  Maze  Machine  vs.  AMAZ3D 


Note  that  node  (7,7)  has  the  largest  error  (approximately  12%  difference),  however,  in 
general  the  two  tables  match  fairly  closely.  As  stated  before,  the  differences  can  be 
e.  olained  by  component  tolerances  in  the  Maze  Machine  (i.e.  resistors),  as  well  as  some 
error  in  the  AMAZ3D  results  due  to  iteration  cut-off  before  absolute  stability/  'settling’. 

Figure  15  shows  another  seven-by-seven  maze  example  (again  with  only 
perpendicular  moves  are  allowed).  This  problem  is  a  sample  of  a  case  where  the  system 
produces  a  non-optimal  solution  path  (see  Appendix  G,  mazno.out).  Table  4  shows  the 
AMAZ3D  voltage  potential  table  for  this  problem. 
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Optional  Path  1 
(16  moves) 

Optional  Path  2 
(16  moves) 


Optional  Path  3 
(14  moves) 
(Shortest!) 


Figure  15 

Analysis  of  AMAZ3D  Non-Optimal  Path  Solution 
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Table  4 

Voltage  Potential  Table  for  AMAZ3D  Non-Optimai  Test  Solution 


The  solution  path  returned  is  Option  Path  1  (16  steps,  highlighted  in  bold  in  Table  4).  Note 
however  that  a  shorter  alternative  path  exists.  Option  Path  3  (14  step,  which  is  highlighted 
in  italics  in  Table  4).  The  explanation  for  this  behavior  can  be  found  by  analyzing  the 
output  potentials.  At  row  7,  col  4,  there  is  a  fork  in  the  solution  paths  of  Option  Path  1  and 
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2.  Due  to  the  initial  combinational  effect  of  these  to  paths,  the  jSrst  step  firam  the  start  node 
is  east,  for  a  voltage  increase  of  .69,  rather  than  west  on  the  actual  shortest  path.  (Note 
that  at  position  (7,4)  the  increases  are  only  .20  for  north  and  .48  for  the  east)  This  is  an 
example  of  why  this  method  can  not  guarantee  global  optimal  solutions  but  only  good 
solutions  based  on  locally’  optimal  moves. 
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Figure  16 

Sample  AMAZ3D  'Connected'-Obstacle  Test  Problem  Solution 
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Figure  16  is  an  example  of  an  outdoor  terrain  environment  where  both  'connected' 
and  'isolated'/  normal  obstacles,  as  well  as  the  eight-way  moves  option,  have  been  used 
(see  Appendix  G,  landnav.out).  This  test  environment  is  one  used  by  Norwood  (1989)  in 
his  work  with  a  potential  field  approach  to  navigation.  Here  the  'connected'  obstacle  nodes 
represent  the  actual  obstacles  (including  two  round  obstacles  in  center  area,  and  two  long 
obstacles  to  the  sides)  and  the  'isolated'  obstacle  nodes  represent  shadow  regions  (based  on 
simulated  laser  scanner  environmental  input  data  taken  on  an  incline  rather  than  top  down). 
This  method  is  an  interesting  alternative  which  warrants  further  study  in  the  future. 
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Figure  17 

Sample  AMAZ3D  Building  Layout  Test  Problem  Solution 


Figure  17  shows  a  typical  building  floorplan  (see  Appendix  G,  bldgnav.out).  This 
example  shows  a  situation  where  the  robot  is  required  to  travel  from  one  room  to  another. 


through  halls  and  doorways  (unused  doors  are  'free  spaces'  shown  with  a  'D').  For  a 
similar  two  story  (3D  problem)  building  example  see  Appendix  G,  bSdnav.out 
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Figure  18 

Sample  AMAZ3D  7-by-7-by-7  3D  Maze  Solution 


As  a  final  example,  Figure  18  shows  the  solution  to  a  seven-by-seven-by-seven 
three-dimensional  test  problem  (see  Appendix  G,  maz3d.out).  This  3D  maze  is  the 
software  equivalent  of  a  plastic  Milton-Bradley  3D  toy/  maze-cube  which  can  be  negotiated 
by  a  marble.  (The  'cube'  is  in  the  possession  of  the  author  and  I  can  verify  that 
AMAZ3D's  solution  is  correct.) 

These  examples  show  some  of  the  capabilities  of  AMA23D.  The  program  can  be 
quickly  reconfigured  for  a  wide  variety  of  navigation  problems  and  the  output  can  be  easily 
modified  for  control  of  a  robotic  vehicle.  Its  only  disadvantage  is  relatively  slow  path 
processing  time.  Typical  computation  time  on  a  PC  is  on  the  order  of  two  thousand  node 
revisions  per  second.  [Thus  total  time  in  seconds  equals:  (rows  *  columns  *  layers  * 
iterations)  /  2000]. 
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Chapter  6 
Conclusions 


The  electronic  hybrid  network  system  presented  in  this  thesis  represents  an  original 
method  for  constrained  semi-autonomous  robotic  navigation  control.  It  takes  simple  binary 
environmental  input,  along  with  a  start  and  goal  location,  and  processes  the  data  through  a 
connectionist  network  which  provides  a  nodal  'voltage  potential'  look-up  table.  The 
voltage  potentials  are  analyzed  by  a  second  network  which  determines  the  move  direction 
based  on  an  examination  of  the  neighborfiood  around  a  given  current  node  (beginning  with 
the  start  position).  Finally,  the  system  presents  a  solution  path  based  on  a  set  of  locally 
optimal  steps. 

This  system  exhibits  some  distinct  advantages  over  the  traditional  approaches  noted 
earlier.  Due  to  the  parallel  architecture  of  the  connectionist  network,  the  system  can  be 
expected  to  be  much  faster  (and  possibly  more  damage  resistant)  than  Artificial  Intelligence 
search  algorithms.  This  navigation  system  also  has  the  flexibility  to  account  for  both 
moving  obstacles  and  a  moving  goal.  This  is  accomplished  by  simply  applying  new  inputs 
to  the  connectionist  network  and  reevaluating  the  path  problem.  Also,  assuming  the  hybrid 
network  syste-'/ 1  is  implemented  in  hardware,  it  does  not  require  a  dedicated  CPU/ 
microcomputer  to  make  it  work  and  could  conceivably  be  built  right  into  the  sensory 
system  and  servomotors  of  a  robot 

An  example  of  a  near  term  use  for  an  expanded  'Maze  Machine'-type  navigation 
system  is  the  control  of  a  robotic  delivery  veliicle  in  a  large  factory.  The  environment/ 
floorplan  would  be  fairly  stable,  however  local  sensors  in  the  factory  could  easily  update 
the  'maze'  database  on  board  the  robot  through  radio  communications.  A  human  or  central 
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computer  would  assign  the  robot  a  task,  probably  also  by  radio  link.  An  example  task 
could  be  to  "take  pallet  #196  from  point  A  to  point  B".  The  navigation  system  on  board  the 
vehicle  would  then  plan  the  path  from  the  current  location  to  point  A  (the  pick  up  point  for 
the  pallet)  and  then  plan  a  second  path  from  A  to  B  (the  pallet  drop  off  point).  Other 
routines  on  board  would  handle  the  pallet  upload/  download  procedure,  emergency  stop 
procedures,  etc. 

There  are  disadvantages  as  well.  First,  the  traditional  AI  procedures,  regardless  of 
whether  they  find  an  optimal  path  or  just  feasible  paths,  are  proven  methods  that  can  be 
implemented  relatively  cheaply  on  microcomputers.  The  network  system  presented  here 
can  not  be  implemented  on  microcomputers  while  keeping  its  parallel  architecture,  however 
the  sequential  simulation  AMAZ3D  can  be  a  valuable  alternative  method,  especially  in 
feasibility  tests  to  determine  if  a  custom  VLSI  network  setup  is  warranted  for  a  particular 
application.  Since  the  AI  approaches  are  software  based,  they  can  be  modified  much  more 
easily  to  represent  different  type/  size  systems  and  environments.  Also,  because  they  are 
tried  and  proven  procedures,  software  is  readily  available  for  their  implementation. 

In  summary,  this  electroruc  hybrid  connectionist  network  system  solves  path 
planning/  obstacle  avoidance  problems  for  a  grid-stractured  two-  or  three-dimensional 
environment  This  navigation  system  provides  good  (often  optimal)  path  solutions  based 
on  a  collection  of  locally  optimal  steps/  moves  found  using  the  output  of  the  sensory 
analysis  connectiortist  network.  It  operates  using  only  low-level  (binary)  descriptions  of 
the  environment  which  can  be  provided  by  a  variety  of  current  and  experimental  sensory 
systems.  The  navigation  machine  would  best  be  used  in  combination  with  a  con:5)uter  and 
global  sensory  input  systems.  Possible  applications  of  this  hybrid  network  system  span 
from  the  home  to  industry  and  even  to  outer  space. 
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Chapter  7 

Areas  for  Future  Work 


The  work  already  done  on  the  development  of  this  hybrid  connectionist  network 
system  opens  many  possibilities  for  future  efforts  to  expand  this  project  and  provides  the 
potential  for  other  developments.  One  very  useful  development  would  be  an  interface  for 
input  and  output  between  a  microcomputer  and  an  expanded  hardware  'Maze  Machine' 
network  device.  An  efficient  system  is  needed  for  updating  the  binary  inputs  of  the 
connectionist  network,  as  well  as  for  quickly  taking  the  path  ouq)ut  and  formating  it  as 
robotic  movement  instructions.  This  interface  would  replace  the  plugs  used  to  establish  a 
particular  maze  initialization  on  the  Maze  Machine,  the  switches  used  to  control  external 
input,  and  the  LEDs  used  for  the  output  displays.  (Figure  A9,  Appendix  A,  shows  an 
improved  system  which  handles  the  functions  of  Modules  1  and  2  of  the  Maze  Machine  and 
also  lends  itself  to  a  computer  interface.)  Another  extension  of  the  research  is  the  use  of 
varied  resistances  and  single  direction  links  in  the  connectionist  network.  These 
modifications  would  be  used  to  simulate  cross-country  travel  across  rough  terrain  (i.e. 
going  uphill  and  downhill  on  varied  slopes)  and  travel  on  city  streets  (where  resistances 
represent  speed  limits  and  one-way  streets  are  modeled  using  diodes/  direction  dependent 
connections).  Testing  the  navigation  system,  using  an  actual  sensory  system  and  robotic 
vehicle,  is  also  desirable  for  greater  whole  system  credibility. 

The  most  obvious  extension  is  the  development  of  a  single  analog  VLSI  chip  to 
represent  a  modular  electronic  hybrid  system  (thus  replacing  the  65  current  'off-the-shelf 
CMOS  IC  chips  used  in  this  project).  A  modular  electronic  system  could  then  be  expanded 
to  represent  much  larger  two-  and  three-dimensional  environments.  An  alternative  to 
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building  a  complete  'Maze  Machine'  on-a-chip  would  be  to  provide  a  combination 
hardware/  software  interactive  system  by  developing  a  plug-in  VLSI  based  connectionist 
network  board  for  microcomputers;  the  computer  would  be  required  to  do  the  auxiliary 
work  but  the  system  would  still  take  advantage  of  the  parallel  processing  structure  of  the 
sensory  analysis  connectionist  network  and  thus  almost  instantaneously  solve  the 
numerous  simultaneous  linear  equations  modeled  by  this  method.  Finally,  this  system 
could  be  developed  for  commercial  use.  Such  uses  could  include  wheelchair  control  to 
help  the  handicapped  navigate  through  a  known  environment  (such  as  their  house)  or  a 
robotic  parts  delivery  system  in  a  factory  or  warehouse.  The  possibilities  are  limited  only 
by  our  imagination. 
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The  following  electronic  diagrams  show  the  stractures  of  the  six  modules  that, 
when  properly  inter-connectexi,  make  up  the  Maze  Machine.  For  more  detailed  wiring 
connection  information  see  Appendix  B,  Maze  Machine  Module  Wiring  Tables.  Notes  for 
each  module  are  as  follows; 

Module  1  •  Input)  Consists  of  hand-placed  electricaUy-wired  'plugs'  (see 
Figure  Al)  which  fit  into  sockets  of  Module  2.  Four  kinds  of  plugs  are  used  to  represent 
the  four  possible  conditions  of  a  node:  obstacle,  free  space,  goal  or  start.  The  wiring 
pattern  for  each  of  the  nodes  results  in: 

1)  Obstacle  node  voltage  outputs  (also  the  outer  boundary)  are  forced  to 
GND  and  the  links  to  its  neighbors  are  disconnected, 

2)  Free  space  node  voltage  outputs  are  allowed  to  'settle'  on  the  average 
value  of  the  neighbor  n^es  influencing  it  (recurrent  behavior). 

3)  Goal  node  voltage  output  is  forced  to  VCC  (source/  supply  voltage) 
and  this  voltage  potential  is  allowed  to  influence  the  neighboring  nodes. 

4)  Start  node  voltage  output  is  forced  to  GND  and  this  voltage  potential  is 
allowed  to  influerce  the  neighboring  nodes. 

Module  2  -  Connectionist  Network)  This  network  module  (see  Figures  A2 
and  A3)  consists  of  49  wired  sockets  interconnected  by  100  kD  resistors  as  shown  in  the 
diagrams.  These  n'xle  sockets  receive  binary  inputs  from  the  Module  1  plugs  and  output 
'voltage  potentials'  (analog)  derived  as  a  function  of  the  various  external  inputs  and  the 
interconnections  between  neighboring  nodes.  Note  that  no  pins  within  a  node  socket  are 
connected  until  a  plug  is  inserted. 
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Modules  -  Multiplexer)  This  module  (see  Figures  A4  and  A5)  multiplexes 
the  49  analog  signals  from  Module  2  (using  current  node  address  from  Module  5)  and 
outputs  five  analog  values.  The  first  four  lines  carry  the  'voltage  potentials'  of  the  four 
nearest  neighbors  of  the  current  node  and  the  fifth  provides  the  current  node's  'voltage 
potential'  as  a  separate  (external)  output  for  sampling. 

Module  4  -  Local-Move-Finder  Network)  This  network  module  (see 
Figure  A6)  takes  input  from  Module  3  and  outputs  four  binary  lines  to  Module  5.  It 
provides  the  next-move  direction  (of  the  four  possibilities),  using  the  greatest  local  voltage 
increase  as  the  decision  criteria. 

Module  5  -  Move  Control)  This  module  (see  Figure  A7)  provides  the  cycle 
control  which  steps  the  machine  through  the  desired  navigation  path,  one  move  at  a  time.  It 
provides  the  current  location  address  to  Module  3  and  updates  this  BCD  location  based  on 
Module  4's  output.  This  module  can  be  provided  with  external  inputs  for  manually  setting 
the  current  address  to  any  desired  value  for  running  special  tests  as  desired  (see  Appendix 
D,  Procedure  for  Running  Maze  Machine  Auto-Path  Test).  This  circuit  also  sends  the 
current  address  to  Module  6.  Not  shown  are  two  BCD  to  7-segment  LED  displays  used  to 
indicate  the  current  row  and  column  and  4  LEDs  used  to  indicate  the  local  move  direction. 

Module  6  -  Path  Output  Display)  This  Module  (see  Figure  A8)  contains 
multiplexing  circuitry  and  49  RS  flip-flops,  one  per  node,  used  to  appropriately  light  an 
array  of  49  LEDs  which  display  the  solution  path  (and  the  intermediate  moves  as  the  path  is 
being  generated). 

Figure  A9  -  Diagram  of  Alternate  Input/  Connectionist  Network  Node 
Structure  (To  Replace  Modules  1  and  2)  is  included  to  show  an  alternative 
hardware  method  which  can  replace  the  'awkward'  plug  and  socket  system  of  Modules  i 
and  2,  The  sketch  shows  the  3 IC  chips  needed  for  each  node. 


47 

Maze  Machine 
Module  1  Diagram  -  Input 


Obstacle  node  plug  Goal  node  plug 


Free  Space  node  plug  Start  node  plug/  alt  obst. 


Figure  A1 

Module  1  Diagram  -  Input 
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Module  2  Diagram  -  Connectionist  Network 
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Figure  A2 

Module  2  Diagram  -  Connectionist  Network 
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Maze  Machine 

Module  2  Diagram  -  Connectionist  Network 

continued 


Partial  Wiring  Diagram  for 
nodes  1,  2,  8,  9,  15,  &  16 


Figure  A3 

Module  2  Diagram  -  Connectionist  Netwo±  continued 
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Module  3  Diagram  -  Multiplexer 
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Figure  A4 

Module  3  Diagram  -  Multiplexer 
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Module  3  Diagram  -  Multiplexer 
continued 
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Figure  A5 

Module  3  Diagram  -  Multiplexer  continued 
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Module  4  Diagram  -  Local-Move-Finder  Network 
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Figure  A6 

Module  4  Diagram  -  Local-Movc-Finder  Network 


Maze  Machine 

Module  5  Diagram  -  Move  Control 
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Figure  A7 

Module  5  Diagram  -  Move  Control 


Diagram  of  Alternate  Input/ 
Connectionist  Network  Node  Structure 
(To  Replace  Modules  1  and  2) 
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Figure  A9 

Diagram  of  Single  Node  for  Alternate  Method 
to  Replace  Modules  1  and  2 
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Appendix  B 

Maze  Machine  Electronic  Module  Wiring  Tables 


The  following  wire  wrapping  tables  are  grouped  by  Maze  Machine  Module  and 
comprise  the  complete  list  of  connections  needed  to  constract  the  machine.  Wire  wrapping 
was  used  rather  than  bread-boarding  or  soldering  in  order  to  keep  the  size  down  and 
simplify  to  the  highly  interconnected  customized  design,  which  incorporated  large  numbers 
of  IC  chip  pin  connections  that  had  multiple  routings  to  other  chips.  The  wire  wrapping 
took  Bill  Atkinson  (see  Acknowledgements)  and  myself  more  than  a  month  to  complete  and 
debug. 

NOTES: 

1)  Module  6's  chip  numbering  does  not  start  with  1,  but  rather  32,  due  to  my  use 
of  a  surplus  60  chip-socket  custom  wire  wrap  board  which  was  prenumbered  and  used  to 
house  both  Modules  3  and  6.  (The  pre-piinted  numbers  on  the  board  were  used.) 

2)  There  are  several  individual  ’chip’  tables,  as  well  as  destination  entries  in  other 
tables,  which  refer  to  Data  Bus(ses)  and  Resistor  Pack.  This  format  was  used  due  to  its 
simplicity,  as  we  as  for  the  fact  that  actual  chip  sockets  and  compatible  jumper  cables  were 
used  to  connect  the  modules  (and  hold  the  needed  resistors  in  some  cases). 
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Module  #3  -  MULTIPLEXER  -  Wiring  Table  B1 
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Module  #3  -  MULTIPLEXER  -  Wiring  Table  Bl,  continued 
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Module  #3  -  MULTIPLEXER  -  Wiring  Table  Bl,  continued 
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Module  #4  -  LOCAL-MOVE-FINDER  NETWORK  -  Wiring  Table  B2 
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Module  #5  -  MO  \ 'S  CONTROL  -  Wiring  Table  B3 
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Module  #6  -  PATH  OUTPUT  DISPLAY  -  Wiring  Table  B4 
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Module  #6  -  PATH  OUTPUT  DISPLAY  -  Wiring  Table  B4,  continued 
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Module  #6  -  PATH  OUTPUT  DISPLAY  -  Wiring  Table  B4,  continued 
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Module  #6  -  PATH  OUTPUT  DISPLAY  -  Wiring  Table  B4,  continued 
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Appendix  C 

Maze  Machine  Tools/  Parts  Required 


The  electronic  'Maze  Machine'  required  funds  in  the  vicinity  of  $360  to  purchase 
the  needed  off-the-shelf  IC  chips  and  accessory  corcponents  necessary  to  build  the  system. 
Thesis  director.  Dr.  John  B.  Cheatham,  Jr.,  provided  monetary  support  for  building  the 
machine  through  a  contract  and  grant  from  NASA/  JSC  and  RICIS. 

The  following  table  shows  the  parts  inventory  for  the  completed  Maze  Machine. 
Note  that  65  IC  chips  are  used  to  constract  the  machine,  however  28  of  the  chips  are 
simply  used  to  store  the  path  output  display  by  way  of  RS  flip-flop  chips  for  memory  and 
an  array  of  LEDs  to  highlight  the  path. 

As  constmcted,  the  machine  requires  an  'awkward'  system  of  hand-placed  plugs  to 
set  the  maze  environment  This  method  was  employed  due  to  low  cost  An  alternative 
system  could  use  CMOS  4066  (quad  digital/analog  bilateral  switchs),  4503  (tri-state  hex 
buffers),  and  4043  (quad  R/S  flip-flop)  chips,  (thus  integrating  Modules  1  and  2).  This 
was  not  pursued  since  the  machine  was  only  built  to  prove  a  concept  and  any  practical  sized 
machine  rvoald  require  custom  analog  VLSI  chips. 

A  practical  implementation  of  this  technology  would  be  through  the  use  of  a  custom 
add-in  board  for  a  microcomputer,  which  would  use  the  aforementioned  VLSI  chips.  The 
computer  would  be  used  for  interfacing  with  both  a  semiautonomous  mobile  robot  (and 
handle  the  robot's  numerous  other  functions)  and  the  Maze  Machine'  on-a-board.  The 
board  would  perform  its  path  planning  functions  (in  real  time,  due  to  the  parallel  processing 
nature  of  the  conncctionist  network)  while  the  computer  directs  the  robot's  actions. 
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MAZE  MACHINE,  Electronic  Hybrid  Network  Parts  Inventory 


M 
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Description 
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5100  resistor  l/4w 

$0.03 

100 

4 

104 

$3.12 

X 

lOkQ  resistor  l/4w 

$0.03 

6 

6 

$0.18 

X 

lOOkO  resistor  l/4w 

$0.03 

84 

2 

86 

$2.58 

X 

8  pin  IC  socket,  wire  wrap 

$0.40 

100 

49 

149 

$59.60 

X 

14  pin  IC  socket,  wire  wrap 

$0.75 

5 

5 

$3.75 

X 

16  pin  IC  socket,  wire  wrap 

$0.75 

24 

1 

■D 

24 

56 

$42.00 

X 

LED  flashing ,  green,  GOAL 

$0.85 

1 

1 

$0.85 

X 

LED  green,  round,  5mm  PATH 

$0.15 

49 

■ 

m 

49 

$7.35 

X 

LED  red,  round,  5mm  OBST 

$0.15 

49 

■H 

■ 

53 

$7.95 

X 

LED  yellow,  md,  5mm  START 

$0.15 

49 

■ 

B 

49 

$7.35 

X 

LED  sockets,  5mm 

$0.10 

4 

4 

$0.40 

X 

decimal  LED  display 

$1.79 

2 

2 

$3.58 

X 

ribbon  connection,  16  strand 

$3.00 

1 

1 

2 

$6.00 

X 

ribbon  connection,  50  strand 

$14.00 

2 

2 

$28.00 

X 

switch  SPDT 

$2.89 

■D 

\mm 

$20.23 

X 

switch  SPDT,  momentary 

$3.69 

1 

1 

2 

$7.38 

X 

protoboard  8"  x  6" 

1 

1 

1 

3 

$18.00 

X 

wire,  wire  wrap,  50ft 

$5.20 

4 

■El 

$20.80 

X 

Socket,  banana  plug 

$1.50 

2 

2 

$3.00 

X 

power  supply,  12v  DC 

$30.00 

1 

■D 

$30.00 

X 

cabinet,  alum,  13x10x4  in. 

$22.94 

1 

mm 

$22.94 

Grand  Total 

$355.93 

Table  Cl 


Maze  Machine  Parts  Inventory 
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Appendix  D 

Procedure  for  Running  Maze  Machine  Auto-Path  Test 


The  following  steps  refer  to  switches  on  the  ftont  face  of  the  Maze  Machine  cabinet 
(Figure  D1  is  a  diagram  of  the  front  of  the  Maze  Machine.) 

1.  Establish/  define  the  maze  environment  by  identifying  obstacles,  free  spaces,  the 
start  node,  and  the  goal  node.  Place  the  required  plugs  in  the  appropriate  node  sockets  on 
the  top  of  the  Maze  Machine.  (Ensure  that  the  plugs  are  oriented  in  the  right  direction.)  The 
plugs  can  be  easily  identified  in  the  following  manner  obstacle  plugs  have  red  stickers, 
firee  spaces  have  green  LEDs  and  green  stickers,  the  start  has  a  green  LED  and  a  yellow 
sticker,  and  the  goal  has  a  regular  green  path  LED  plus  a  blinking  green  LED. 

2.  With  the  machine  in  the  MANUAL  mode,  use  the  "manual  current  node  input" 
switches  to  set  the  start  point  (i.e.  row  and  column,  using  binary  representation).  Push  the 
cycle  button  to  load  the  data  to  the  Move  Control  Module.  The  start  node  LED  will  light 
and  the  current  node  display  will  indicate  the  current  location  digitally  (i.e.  row  and 
column).  Also,  one  red  direction  indicator  LED  will  light,  indicating  the  direction  m  which 
to  move. 

3.  Next,  place  the  machine  in  the  AUTO  mode.  Push  the  cycle  button  to  take  one 
step  along  the  path.  The  appropriate  path  LED  on  the  top  of  the  machine  will  hght  and  the 
current  node  location  digital  display  and  direction  indicator  LED  will  become  updated 
accordingly.  Continue  to  take  one  step  at  at  time,  by  pushing  the  cycle  button,  until  the 
entire  path  is  lit-up  and  the  goal  node  is  reached. 
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4.  To  start  over  and  clear  the  maze  path  display,  simply  push  the  spring  loaded 
MEM/  CLR  toggle  switch  to  CLR  and  release.  The  machine  will  now  be  reset  and  all  maze 
LEDs  will  be  off  except  the  blinking  goal. 


Maze  Machine  External  Input  and  Output  Display 


NOTE: 

To  read  out  the  current  node  voltages,  plug  a  voltmeter  into  the  back  of  the  machine 
at  the  marked  socket  and  either  take  readings  as  you  step  through  a  maze  problem's  path  or 
use  the  MANUAL  switch  and  manual  current  node  input  toggles  to  select  the  desired 
node(s)  for  voltage  sampling. 
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Appendix  E 

Maze  Machine  Test  Data  and  Results 


The  Maze  Machine  was  tested  using  a  variety  of  sample  'mazes'  /  path  planning  and 
obstacle  avoidance  problems.  The  machine  consistently  provided  good  (near-optimal) 
solutions  based  on  the  environment  and  assumptions  imposed. 

In  the  tests  ran,  the  environment  usually  contained  more  than  one  feasible  path 
(from  start  to  goal).  After  setting  the  environment  (by  defining  start,  goal,  free  space,  and 
obstacle  nodes),  voltage  readings  were  taken  for  each  node  in  the  'maze'.  After  sampling 
the  voltage  outputs,  the  test  navigation  problem  was  run  on  the  Maze  Machine.  As  stated 
earlier,  in  each  case,  the  machine  successfully  navigated  the  maze  and  avoided  obstacles 
while  selecting  a  good  (best,  from  a  local  voltage  increase  basis)  path.  The  results  of  some 
sample  tests  that  were  run  are  included  as  tables  in  this  appendix.  Their  significance  are  as 
follows; 

Table  El:  Test  1  shows  the  maze  from  Figure  2  in  the  Introduction  Chapter. 
First  the  'Maze  Mask'  with  start  and  goal  positions  is  displayed.  Next,  the  Vout  Sampling 
Table  with  voltage  potential  output  values  listed  per  node.  Finally  the  Auto-Path  Results 
are  shown 

T  •  '  t  2a  shows  a  new  maze  layout,  with  'Maze  Mask'  -f-  start  &  goal, 

Vout  Samp  '  nd  Auto-Path  Results. 

Table  E3:  Test  2b  uses  the  same  'Maze  Mask'  as  Test  2a,  however  the  start 
position  has  been  altered.  Note  new  Vout  Sampling  Table  and  Auto-Path  Results. 

Table  E4:  Test  3a  shows  a  new  maze  layout  where  the  'Maze  Mask'  contains 
no  obstacles.  This  test  was  run  to  show  the  tolerance  errors  in  the  hardware  system.  Note 
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that  since  the  start  &  goal  were  placed  in  opposing  comers  the  system  is  symmetrical.  The 
Vout  readings  should  be  identical  on  the  cross  diagonals  (perpendicular  to  straight  line 
between  start  and  goal).  The  small  errors  found  in  the  actual  Vout  readings  can  be 
accounted  for  easily  by  the  tolerances  in  the  components  that  make  up  the  Maze  Machine 
(especially  the  resistors  of  Module  2,  each  with  a  5%  manufactures'  tolerance).  Also  note 
that  any  path  that  moves  only  right  or  down  (East  or  South)  is  equally  good  based  on  the 
assumptions/  limitations  made. 

Table  E5:  Test  3b  uses  the  same  no  obstacle  'Maze  Mask'  as  Test  3a,  however 
the  start  position  has  been  altered.  Note  new  Vout  Sampling  Table  and  Auto-Path  Results. 

Table  E6:  Test  4  shows  the  maze  from  Figure  14  and  Table  1  in  Chapter  4. 
Here  again,  the  'Maze  Mask'  with  start  and  goal  positions,  along  with  the  Vout  Sampling 
Table  and  Auto-Path  Results  are  shown. 


MAZE  MACHINE,  Test  Run  Printout 


Testl 


Maze  Mask  +  External  Inputs: 


1 

2 

3 

4 

5 

6 

7 

1 

Start 

XXX 

XXX 

2 

XXX 

XXX 

XXX 

3 

XXX 

XXX 

XXX 

4 

XXX 

XXX 

5 

XXX 

XXX 

XXX 

XXX 

6 

XXX 

XXX 

7 

XXX 

XXX 

Goal 

Vout  Sampling: 


1 

2 

3 

4 

5 

6 

7 

1 

0.00 

0.00 

4.43 

4.98 

5.53 

6.10 

0.00 

2 

1.11 

0.00 

3.88 

0.00 

0.00 

6.68 

7.25 

3 

2.22 

2.77 

3.35 

0.00 

0.00 

■BTilil 

7.84 

4 

2.72 

0.00 

3.28 

0.00 

7.35 

7.89 

8.47 

5 

3.24 

0.00 

0.00 

0.00 

6.80 

0.00 

9.57 

6 

3.75 

4.25 

0.00 

6.32 

0.00 

10.73 

7 

0.00 

4.75 

5.25 

6.01 

■fftra 

11.92 

Auto  Path  Results: 


1 

2 

3 

4 

5 

6 

7 

1 

V 

XXX 

> 

> 

> 

V 

XXX 

2 

V 

XXX 

A 

XXX 

XXX 

> 

V 

3 

> 

> 

A 

XXX 

XXX 

XXX 

V 

4 

XXX 

XXX 

V 

5 

XXX 

XXX 

XXX 

XXX 

V 

6 

XXX 

XXX 

V 

7 

XXX 

XXX 

Goal 

Comments: 

Successfully  navigated  the  maze  while 
minimizing  the  number  of  moves  required. 


Table  El 


MAZE  MACHINE,  Test  Run  Printout 


Test  2a 


Maze  Mask  +  External  Inputs: 

1  2  3  4  5  6  7 


XXX 

Goal 

XXX 

XXX 

XXX 

XXX 

XXX 

XXX 

XXX 

XXX 

Start 

XXX 

XXX 

XXX 

XXX 

Vout  Sampling: 


1 

2 

3 

4 

5 

6 

7 

1 

3.30 

0.00 

7.30 

~iir 

1W 

10.28 

11.95 

2 

3.25 

0.00 

6.83 

7.51 

7.88 

0.00 

10.89 

3 

3.38 

4.52 

IW 

0.00 

7.43 

0.00 

0.88 

4 

2.21 

0.00 

0.00 

0.00 

7.01 

0.00 

5 

1.05 

0.00 

0.73 

0.00 

6.60 

0.00 

7.95 

6 

0.92 

0.79 

1.44 

0.00 

6.22 

6.49 

7.02 

7 

0.91 

0.00 

2.81 

4.17 

5.54 

6.21 

6.59 

Auto  Path  Results: 


1  2  3  4  5  6  7 


XXX 

> 

> 

Goal 

XXX 

> 

> 

A 

XXX 

> 

> 

A 

XXX 

XXX 

A 

XXX 

XXX 

XXX 

XXX 

A 

< 

XXX 

XXX 

XXX 

XXX 

Comments: 

Successfully  navigated  the  maze  while 

the  number  of  moves  required. 


Table  E2 


MAZE  MACHINE,  Test  Run  Printout  Test  2b 

Maze  Mask  +  External  Inputs: 


1 

2 

3 

4 

5 

6 

7 

i 

XXX 

Goal 

2 

XXX 

XXX 

3 

XXX 

XXX 

4 

XXX 

XXX 

XXX 

XXX 

5 

XXX 

XXX 

6 

XXX 

7 

Start 

XXX 

Vout  Sampling: 


1 

2 

3 

4 

5 

6 

7 

1 

■ilKil 

8.17 

T62l 

11.95 

2 

4.92 

7.80 

8.36 

8.66 

11.10 

3 

4.97 

5.89 

10^ 

0.00 

8.31 

0.00 

loos' 

4 

wmm 

IQ2EI 

mu 

mmM 

9.52 

5 

EEa 

3.44 

0.00 

jBm 

giXCil 

8.76 

6 

em 

3.75 

msM 

7.62 

1^ 

7 

Hilil 

5.82 

mm 

WEil 

mmm 

Auto  Path  Results: 


1 

2 

3 

4 

5 

6 

7 

1 

XXX 

> 

> 

Goal 

2 

XXX 

> 

> 

A 

XXX 

3 

> 

> 

A 

XXX 

XXX 

4 

A 

XXX 

XXX 

XXX 

XXX 

5 

A 

XXX 

XXX 

6 

A 

XXX 

7 

A 

XXX 

Comments: 

Successfully  navigated  the  maze  while 
minimizing  the  number  of  moves  required. 


Table  E3 


MAZE  MACHINE,  Test  Run  Printout 


Test  3a 


Maze  Mask  +  Externi  *  inputs: 

1  2  3  4  5  6  7 


Start 

Goal 

Vout  Samplikig: 


1 

2 

3 

4 

5 

6 

7 

11  0.00 

2.32 

3.71 

4.63 

5.27 

5.69 

5.87 

2 

2.31 

3.25 

4.16 

glBcl 

5.51 

5.91 

6.10 

3 

3,70 

4.16 

4.77 

5.38 

5.91 

6.32 

6.52 

4 

4,63 

4.93 

5.39 

5.93 

■i:4r 

6.91 

7.18 

5 

Wk 

5.41 

muffju 

rn^rm 

jgim 

mmm 

6 

5.91 

6.31 

^1 

gygii 

9.51 

7 

5.87 

"310" 

6.52 

7,17 

8.10 

9.50 

11.84 

Auto  Path  Results: 


1 

2 

3 

4 

5 

6 

7 

1 

> 

> 

IQI 

B 

> 

V 

2 

_ 

B 

V 

3 

■1 

V 

4 

B 

V 

B 

5 

V 

B 

6 

Bi 

B 

V 

7 

B 

_ 

B 

Goal 

Comments: 

Successfully  navigated  the  'non-maze'  while 
minimizing  the  number  of  moves  required. 


Table  E4 


MAZE  MACHINE,  Test  Run  Printout 


Test  3b 


Maze  Mask  +  External  Inputs: 

1  2  3  4  5  6  7 

1 
2 

3 

4 

5 

6 
7 


Goal 

Star: 

Vout  Sampling; 


1 

2 

3 

4 

5 

6 

7 

1 

6.15 

6.21 

6.55 

7.20 

8.11 

9.52 

11.84| 

2 

5..52 

5.89 

6.30 

6.91 

7.66 

8.57 

9.48  ' 

3 

5.17 

5.45 

5.87 

6.42 

7.01 

7.63 

8.05 

4 

4.58 

4.89 

5.34 

5.90 

6.42 

6.88 

7.14 

5 

3.66 

4.12 

4.72 

5.35 

5.86 

6.26 

6.46 

6 

2.29 

3.21 

4.12 

4.89 

5.46 

5.86 

6.04 

7 

0.00 

2.30 

3.65 

4.56 

5.20 

5.62 

5.80 

Auto  Path  Results: 

1 

2 

3 

4 

5 

6 

7 

1 

> 

Goal 

2 

A 

3 

A 

4 

A 

5 

A 

6 

A 

7 

> 

> 

> 

> 

> 

A 

Comments: 

Successfully  navigated  the  'non-maze*  while 
minimizing  the  number  of  moves  required. 


Table  E5 


MAZE  MACHINE,  Test  Run  Printout 


Test  4 


Maze  Mask  +  External  Inputs: 


1 

2 

3 

4 

5 

6 

7 

1 

XXX 

Goal 

2 

XXX 

XXX 

XXX 

XXX 

3 

XXX 

XXX 

4 

XXX 

XXX 

XXX 

XXX 

5 

XXX 

XXX 

6 

XXX 

XXX 

XXX 

7 

Start 

Vout  Sampling: 


1 

2 

3 

4 

5 

6 

7 

1 

0.00 

6.86 

6.86 

6.86 

8.03 

9.29 

10.53 

2 

6.72 

6.76 

0.00 

5.60 

0.00 

0.00 

0.00 

3 

6.62 

0.00 

4.44 

4.45 

4.07 

3.80 

0.00 

4 

0.00 

0.00 

0.00 

3.47 

0.00 

3.51 

3.20 

5 

1.33 

1.72 

2.13 

2.56 

6.00 

"CloCT 

IW 

6 

0.87 

0.00 

0.00 

2.06 

0.00 

2.40 

2.70 

7 

0.44 

0.00 

0.80 

1.60 

1.83 

2.12 

2.09 

Auto  Path  Results: 


1 

2 

3 

4 

5 

6 

7 

1 

XXX 

> 

> 

> 

Goal 

2 

■i 

XXX 

A 

XXX 

XXX 

XXX 

3 

B 

XXX 

wm 

XXX 

4 

XXX 

XXX 

XXX 

A 

XXX 

5 

■■ 

XXX 

XXX 

6 

tm 

XXX 

XXX 

A 

XXX 

7 

B 

> 

> 

A 

Comments: 

Successfully  navigated  the  maze  while 
minimizing  the  number  of  moves  required. 


Table  E6 


Appendix  F 

AMAZ3D.f  Source  Code  Listing 
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The  AMAZ3D.f  program  code  was  written  in  FC:'.  i  n  AN?"  The  main  program 
AMAZSD.f  along  with  its  subroutines  comprise  the  complete  serial  computer  simulation  for 
the  hybrid  connectionist  network  system  used  for  path  planning  and  obstacle  avoidance. 
'Iite  subprograms  used  are  listed  below,  along  with  short  explanations  of  there  functions: 

program  AMAZ3D  is  the  main  program  for  finding  good  paths  through  3D 
mazes. 

subroutine  MAZLGO(UNIT)  prints  the  AMAZ3D  logo  to  device  labeled  U. 

subroutine  MAZINP  inputs  maze  data  and  set  WTS  array. 

subroutine  MAZOUT(U)  outputs  maze  environment  (and  any  ;  data  such 
as  start,  goal  and  path  steps  if  calculated)  to  device  labeled  U. 

subroutine  PAROlJT(U)  outputs  parameter/  maze  data  to  device  labeled  U. 

subroutine  tiPDATE  allows  user  to  modify  maze/  parameter  data  before  going 
to  iteration  process. 

subroutine  MAZPOT  converts  maze  input  data  from  a  character  array  MAZ  to  a 
value  array  POT,  plus  it  initializes  the  array  PFUD  (the  nodal  voltage 
potendais  array). 

subroutine  MAZFLD  calculates  final  values  for  potential  field  OTay  by  iteration 
process  and  shows  in-progtess  error  calculations  for  every  10  iterations. 

subroutine  MAZFNL(U)  outputs  nodal  voltage  potential  field  to  device  labeled 
U. 

subroutine  MAZMOV  calculates  path  in  a  step-by-step  procedure  using  locally 
optimal  moves/  steps. 

subroutine  MAZPTH(U)  outputs  the  solution  path  in  a  list  format  (includes 
path  ncc’  vector  addres^s  and  next  move  directions)  to  device  labeled  U. 

function  MAZDDl(IDrR)  produces  direction  character  string  from  integer  input 
(i.e.  N,  E,  S,  \V,NE,  SE,  SW,  and  NW). 
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subroutine  bell(NUM)  rings  bell  NUM  times  to  alert  user  to  input 
requirements. 

The  AMAZ3D  program  also  reads  in  three  datr  files: 

amaz3d.prf  (A  preferences  file  for:  1)  describing  the  screen  output  device 

number,  6  for  IBM  PC  and  SUN  workstations,  9  for  Macintosh  PC  and  2) 
FILEDF,  the  default  file-name  for  the  assumed  input  parameter  file.), 

FBLEDF  or  file-name  entered  by  user  (A  parameter  file  which  provides  key 
information  to  the  program.  All  parameters  but  the  sensory  data  file  array 
dimensions  and  FILEM,  the  initial  node  values  file,  can  be  modified  later  by 
the  user  vtithin  the  AMAZ3D  program.), 

FDLEM  (Sensory  data  input  file,  name  provided  by  above  mentioned  parameter 
file,  which  provides  AMAZ3D  program  with  initial  en'/ironmental  sensory 
data  for  the  nodal  array  which  was  dimensioned  through  FILEDF  entries.). 


Notes: 

1)  To  keep  the  program  memory  requirements  reasonable  for  a  microcomputer, 
the  maximum  sensory  data  input  file  has  been  limited  to  a  three  dimensional 
array  of  80  rows  by  80  columns  by  8  layers  of  height  (thereby  requiring 
approximately  1  Mbyte  RAM),  lliese  values  are  arbitrary,  of  course,  and 
can  be  chang^  in  the  variable  declaration  statements  of  the  program  source 
code  before  compilation.  The  only  limitation  is  memory  av^ability. 

2)  Also  note  that  two  types  of  obstacles  have  been  allowed  for:  1)  'normal' 
obstacles  are  set  to  GND  and  are  isolated  from  their  neighbors  in  the 
network  (i.e.  do  not  influence  the  neighbors'  nodal  value  outputs)  and  2) 
'connected'  obstacles  which  have  the  same  characteristics  as  tiie  start  node 
(i.e.  set  to  GND  but  left  connected  to  the  network  so  that  their  influence  is 
felt  by  the  neighboring  free  nodes).  This  second  type  of  obstacle  node 
allows  the  program  to  approximate  the  potential  fields  approach  used  by 
Norwood  (1989)  in  his  Master's  Thesis  on  "Robotic  Path  Planning  and 
Obstacle  AvoicMce:  A  Neural  Network  Approach". 
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Program  AMAZ3D.f  Source  Code  Listing 

C - + - 1 - 2 - 3 - 4 - 5 - 6 - 7- 

program  AMAZ3D 

c  main  program  for  finding  good  paths  through  3D  mazes 
c  declaration  of  global/common  variables 

integer  SCR,FIL,ROW,COL,DEP,STARTN{3) ,GOALN(3) 

integer  MAXIT, CNT, MOVE, I, J, K, DIRALL 

real  OBSX,OBSC,GND,VCC,DIST 

real  ALLERR, ACTERR, TTLERR 

integer  WTS(0:81, 0:81, 0:9) 

real  POT (0 : 81, 0 ;81, 0 : 9) 

real  PFLD(0:81, 0:81, 0:9) 

integer  PATH (0 : 1000, 4) 

character *12  FILEDF, FILEP, FILEM, FILEO 

character*!  MAZ (0:81, 0:81,0:9) 

character*!  OBSTX, OBSTC, FREEl, FREE2, FREE3, START, GOAL 
common  SCR,FIL,  ROW,COL,DEP,  STARTN,  GOALIJ,  MAXIT, 

2  CNT , MOVE, I , J, K, DIRALL, OBSX, OBSC , GND , VCC , DIST, 

3  ALLERR, ACTERR, TTLERP,WTS, 

4  POT, PFLD, FILEDF, FILEP, FILEM, FILEO, PATH, 

5  MAZ, OBSTX, OBSTC,FREEI,FREE2,FREE3, START, GOAL 
c  declare  local  variables 

character*!  BYPASS, QOITER 

logical  PRFEXS 

0  SCR  =  screen  device/unit  #  default 
c  FILEDF  =  default  parameter  input  file 
c  read  in  preference  file  for  SCR, FILEDF 

inquire  ( file** '  amaz3d .  pr  f ' ,  exist**PRFEXS) 
if  (.not. PRFEXS)  then 

pause  'Needed  preference  file  "amazSd.prf"  not  found!  ' 
stop 
endif 

open (2, fila='amaz3d.prf ' ) 
read(2,2000)  SCR, FILEDF 
2000  format (il/, al2/) 
close (2) 

c  FIL  *=  output-file  unit  defauit 
FIL  **  8 

c  print  logo  to  screen 
10  call  MAZLGO!SCR) 
c  input  parameter  data 
call  PARINP 
c  input  maze  data 
call  MAZINP 

c  update  maze/parameter  data 

write (*,*)  'Maze  Environment...  ' 
call  MAZOOT(SCR) 
if  (SCR.eq.9)  call  bell(l) 

if  (SCR.eq.9)  pause  'press  <CR>  to  continue...  ' 
if  (SCR.eq.9)  write  (*,*) 
call  PAROUT.rCR) 
call  UPDATE 

c  output  maze/parameter  data  to  file 

write (FIL, *)  'Maze  Environment...  ' 
call  MAZOUT(FIL) 
call  PAROUT(FIL) 

c  create  real  valued  array  from  char  array 
call  MAZPOT 

c  calc  final  values  for  pot  fid  array 


call  MAZFLD 
call  bell(l) 
write (*, 2010) 

2010  format ( 'Enter  <y>  to  printout  the  pot.  values  array,  or', 
+  '  <CR>  to  bypass  output  of  potential  values 

BYPASS= '  ' 

read(»,  '  (al)  ■)  BYPASS 
write (*, *) 

if  (BYPASS.ne  .  ‘  Y'  .and.  BYP ASS . r.e .  ' y ' )  goto  20 
c  output  final  potential  field 
call  MAZFNL(SCR) 
call  MAZFNL(FIL) 
c  output  final  iteration  info 
20  write (*,2030)  CNT, ACTERR,TTLERR 

write (FIL, 2030)  CNT,ACTERR,TTLERR 
2030  formate/'  Total  Iterations  =  ' , i8, / 

2  'Maximum  individual  nodal  change  -  ',f8.4,/ 

3  '  Total  iteration  nodal  change  =•  ',f8.4//) 
if  (SCR.eq.9)  call  bell(l) 

if  (SCR.eq.S)  pause  'press  <CR>  to  continue...  ' 
if  {SCR.eq.9)  write{*,*) 
c  calculate  path 
call  MAZMOV 
c  output  path 

call  MAZPTH(SCR) 
call  MAZPTH(FIL) 
if  (SCR.eq.9)  call  belldj 

if  (SCR.eq.9)  pause  'press  <CR>  to  continue...  ’ 
if  (SCR.eq.9)  writc{*,*) 
write (*,*) 

c  output  maze  solution  (in  character  form) 
write {*,*)  'Maze  Solution...  ’ 
call  MAZOUKSCR) 
write (FIL,*) 

write (FIL, *)  'Maze  Solution...  ' 
call  MAZOOT(FIL) 
write (*, *) 

write (*,*)  'NOTE:  Duplicate  A-MAZ3D  output', 

+  '  written  to  file  '.FiLEO 

close  (FIL) 
call  bell(i) 
write (*,2040) 

2040  format  (/'Enter  <Y>  to  restart  program,  or',/ 

+  '  <CR>  to  quit  ;  •$) 

Q0ITER='  ' 

read(*, ' (al) ')  QUITER 
write (*, *) 

if  (QUITER. eq. 'Y'  .or.  QUITER. eq. 'y' )  goto  10 
end 
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C - + - 1 - 2 - 3 - 4 - 5 - 6 - 7 

subroutine  MAZLGO(ONIT) 
c  printout  logo 
c  declare  local  variable 
integer  UNIT 
write (UNIT, 2000) 

2000  format (/ 

2  ' %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%', / 


3 

4 

'% 

'% 

A  M  M 

A 

ZZZZZ 

333 

DDDD 

%',/ 

%',/ 

5 

'% 

A  A  MM  MM 

A  A 

Z 

3 

D  D 

%',/ 

6 

'% 

AAAAA  M  M  M  M 

AAAAA 

Z 

33 

D  D 

%',/ 

7 

'% 

A  A  M  M  H 

A  A 

Z 

3 

D  D 

%’,/ 

8 

'% 

A  A  M  M 

A  A 

ZZZZZ 

333 

DDDD 

%’,/ 

9 

'% 

%’,/ 

-f  '  %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%',  / 

1  'Chris  Schuster  MEMS/Robotics,Rice  University  v6.03',/ 

2  /) 
return 
end 

subroutine  PARINP 
c  input  parameter/maze  data 
0  declaration  of  global/common  variables 

integer  SCR,FII<,ROW,COL,DEP,STARTN(3)  ,GOALN(3) 

integer  MAXIT,CNT,MOVE,I,  J,K,DIRALL 

real  OBSX,OBSC,GND,VCC,DIST 

real  ALLERR, ACTERR, TTLERR 

integer  WTS(0:81, 0:81, 0:9) 

real  POT{0:81, 0:81,0:9) 

real  PFLD (0:81, 0:81,0 ,9) 

integer  PATH (0:1000, 4) 

character*12  FILEDF, FILEP, FILEM, FILEO 

character*!  MAZ(0:81, 0:81, 0:9) 

character*!  OBSTX, OBSTC, FREEl,  FREE2, FREE3, START, GOAL 

common  SCR, FIL, ROW, COL, DEP, STARTS, COALS, MAXIT, 

2  CNT , MOVE , I , J, K, DIRALL, OBSX, OBSC , GSD , VCC , D I ST , 

3  ALLERR,ACTERR,TTLERR,WTS, 

4  POT, PFLD, FILEDF,  FILEP,  FILEM, FILEO, PATH, 

5  MAZ, OBSTX, OBSTC, FREEl, FREE2 , FREE3, START, GOAL 
c  declare  local  variables 

logical  PAREXS 

c  get  parameter  file-name,  (default  parameter_file  -  FILEDF) 

10  FILEP=FILEDF 

call  belKl) 
write (*,2000)  FILEP 

2000  format ( 'Enter  <CR>  for  the  default  parameter  file  ',al2,/ 

+  '  or  <file_name>  of  a  custom  parameter  file  :  '$) 

read(*, ' (al2' ' )  FILEP 

if  (FILEP. eq.'  ')  FILEP=FILEDF 

write (*, *) 
write  (*,  *) 

inquire  (f,.le’‘FILEP,exist=>PAREXS) 
if  (PARr  (S)  ^oto  20 

writ',  (*,'')  '  Parameter  file  ’, FILEP,'  not  found!  ' 
write  (*,  *) 

goto  '0 

c  input  program  parameters 
20  FILEDF  =  FILEP 
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opend,  file-FILEP) 

read (1,2010)  ROW, COL , DEP , OBSTX, OBSTC ,FREE1,FREE2, FREES, START, 

2  GOAL,STARTN(l) ,STARTN(2)  ,STARTN(3) ,GOALN(l) , 

3  GOALN ( 2 ) , GOALS  <  3 ) ,  OBSX , OBSC , 

4  GND, VCC, ALLERR, MAXIT,  FILEM, FILEO, DIRALL 
2010  format  (3 (13/)  ,  7 (al/) , 6 (13/) , 5 (gl2 .5/) , 15/, 2 (al2/) ,  il/) 

close (1) 

inquire (file=FILEM, exist=PAREXS) 
if  (PAREXS)  goto  8888 

write(*,*)  '  Maze  data  file  *, FILEM, '  not  found!' 
write (*, *) 
goto  10 
8888  return 
end 

subroutine  MAZINP 
c  input  maze  data,  set  WTS  array 
c  declaratii-n  of  global/common  variables 


integer 

SCR, FIL, ROW, COL, DEP,  STARTS (3) , GOALN (3) 

integer 

MAXIT, CNT, MOVE, I, J, K, DIRALL 

real 

OBSX, OBSC, GND, VCC,  DIST 

real 

ALLERR,  ACTERR,  TTLERR 

integer 

WTS(0:81, 0:81, 0:9) 

real 

POT(0:81, 0:81, 0:9) 

real 

PFLD(0:81, 0:81, 0:9) 

integer 

PATH (0:1000, 4) 

oharacter*12 

FILEDF, FILEP, FILEM, FILEO 

character*! 

MA2(0:81, 0:81, 0:9) 

character*! 

OBSTX , OBSTC , FREEl ,  FREE2 ,  FREE3 , START , GOAL 

common 

SCR, FIL, ROW, COL, DEP, STARTS, GOALN, MAXIT, 

2  CNT, MOVE, I, J, K,  DIRALL,  OBSX,  OBSC, GND, VCC, DIST, 

3  ALLERR , ACTERR, TTLERR,  WTS , 

4  POT, PFLD, FILEDF, FILEP, FILEM, FILEO, PATH, 

5  MAZ , OBSTX, OBSTC, FREEl,  FREE2 , FREE3 , START, GOAL 
c  declare  local  variables 

integer  INK 

c  initialize  maze  outer  boundaries  to  obstacle  nodes 
c  init  top  and  bottom  of  maze 
do  20  J=0,COL+1 
do  10  I»=0,ROW+1 
MAZ(I,J,  0)=OBSTX 
MAZ ( I, J, DEP+1 ) “OBSTX 
10  continue 

20  continue 

c  init  sides  of  maze 
do  50  K=1,DEP 
do  30  J=0,COL+1 
MAZ  (0,J,K)  “OBSTX 
MAZ (ROW+1, J,K) “OBSTX 
30  continue 

do  40  1=1, ROW 

MAZ  (I,  0,K)  “OBSTX 
MAZ ( I , COL+1 , K) “OBSTX 
40  continue 

50  continue 

c  read  in  maze  data  (layer  by  layer) 
opend,  file=FILEM) 
do  70  K=1,DEP 

if  (DEP.ne.l)  then 
readd,  '  (i3) ')  INK 
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if  (INK.ne.K)  then 

pause  'error  reading  in  maze  data  file  !!!' 
stop 
endif 
endif 

do  60  1=1, ROW 

readd,  2000)  (MAZ  (I,  J,K) ,  J=l,COL) 

2000  format (128al) 

60  continue 

70  continue 

close <1) 

return 

end 

c - + - 1 - 2 - 3 - 4 - 5 - 6 - 7 

subroutine  MAZOOT(U) 

c  output  extended  maze  to  screen  and  file  FILED 

c  declaration  of  global/common  variables 

integer  SCR, FIL, ROW,COL,DEP,STARTN (3) , GOALN (3) 

integer  MAXIT, CNT, MOVE, I, J, K, DIRALL 

real  OBSX,OBSC,GND,VCC,DIST 

real  ALLERR, ACTERR, TTLERR 

integer  WTS(0:81, 0:81, 0:9) 

real  POT(0:81, 0:81, 0:9) 

real  PFLD(0:81, 0:81, 0:9) 

integer  PATH(0:1000,4) 

character*12  FILEDF,FILEP,FILEM, FILED 

character*!  MAZ(0:81, 0:81, 0:9) 

character*!  OBSTX,OBSTC, FREE!, FREE2,FREE3, START, GOAL 

common  SCR, FIL, ROW, COL,DEP, STARTN, GOALN, MAXIT, 

2  CNT , MOVE, I , J, K, DIRALL, OBSX, OBSC, GND , VCC, DIST, 

3  ALLERR, ACTERR, TTLERR,  WTS, 

4  POT, PFLD, FILEDF, FILEP, FILEM, FILED, PATH, 

5  MAZ, OBSTX, OBSTC, FREE!, FREE2 , FREE3 , START, GOAL 
c  declare  local  variables 

integer  COLOMN  (0: 129) 

integer  0 

c  output  initial  maze  parameters 

write (0, 2000)  FILEM, ROW, COL, DEP, OBSTX, OBSTC,  FREEl , FREE2 , FREES , 

+  START, {STARTN (I), 1=1, 3), GOAL, (GOALN (I) , 1=1, 3) 

2000  format (/,'  The  Maze:  ',al2, ’  has  ',13,'  Rows  ,', 

2  13,'  Cols  ,',i3,'  Depth  Layer(s)', 

3  //'  Key:  Obstacles  -  ',al,'  (isolated)  ,  ',a!, 

4  '  (connected)',/'  Free  Space  =  ',a!,3x, 

5  '(  +  ',a!,  '  (doors)  ,  ',a!, '  (elevators)  ]',/ 

7  '  Start  node  =  dal,'  ,  at  ( ',  i3, ' ,  ' ,  i3,  ' ,  '  ,13,  ' )  ' ,  / 

8  '  Goal  node  =  ’,al,  '  ,  at  (',i3, ', ',i3, ', ’,i3, ') ',/) 

c  create  column  header 

do  20  1=0,12 
do  10  J=0,9 

COLUMN (!0*I+J) =J 
10  continue 

20  continue 
c  output  maze 

c  first  chec)c  if  DEP  =  !  or 
c  horizontal  printout  of  layers  is  practical 

if  (DEP.eq.l  .or.  (COL+3)*DEP  .gt.  80)  goto  100 
c  for  horz  layers:  output  depth  layer  titles 
write(0,2010) 


2010  formate  ',$) 

do  30,  K=1,DEP 
write (0,2020)  K 

2020  f ormat { '  Depth ',i2,$) 

30  continue 
write (0, *) 

c  output  column  headers 

write{U, 2030)  ((char(48+COLOWH(J)),J=l, COL),  '  ’,K=1,DEP) 

2030  formate  ',12831) 

write (0, *) 

c  output  row  headers  and  mazes 
do  40,  1=1, ROW 

write(0,2040)  I,  ( (MAE  (I,  J,K) ,  J=l,  COL) ,  '  ',K=1,DEP) 

2040  format (i3,3x,128al) 

40  continue 

.;oto  8888 

c  for  layers  printed  out  vertically: 

c  output  column  header 

100  write (0,2050)  (COLUMN (J) , J»l, COL) 

2050  formate  ',128il) 

write (0, *) 
do  120,  K=1,DEP 

if  (DEP.ne.l)  then 

write  (0,  *) 

write (0,*)  'Depth  Layer ;',K 
endif 

do  110,  1=1, ROW 

write(0,2060)  I,  (MAZ(I,  J,K)  ,  J-l,COL) 

2060  format  (i3,3x,128al) 

110  continue 

120  continue 

8888  return 

end 

c - + - 1 - 2 - 3 - 4 - 5 - 6 - 7 


subroutine  PAROUT(O) 
c  output  parameter /maze  data 
c  declaration  of  global/common  variables 

integer  SCR,FIL,ROW,COL,DEP,STARTN(3)  ,GOALN(3) 

integer  MAXIT, CNT,MOVE, I, J, K, DIRALL 

real  OBSX,OBSC,GND,VCC,DIST 

real  ALLERR,ACTERR,TTLERR 

integer  WTS (0 : 81,  0 : 81, 0 : 9) 

real  POT(0:81, 0:81,0:9) 

real  PFLD(0:81, 0:81, 0:9) 

integer  PATH(0:1000,4) 

character*12  FILEDF, FILEP, FILEM,  FILED 

character*!  MAZ (0:81, 0:81, 0:9) 

character*!  OBSTX, OBSTC, FREEl, FREE2, FREE3,  START, GOAL 
common  SCR, FIL, ROW, COL, DEP , STARTN, GOALN, MAXIT, 

2  CNT, MOVE, I, J, K, DIRALL, OBSX,  OBSC, GND, VCC, DIST, 

3  ALLERR, ACTERR, TTLERR, WTS , 

4  POT, PFLD, FILEDF, FILEP, FILEM, FILEO, PATH, 

5  MAZ , OBSTX, OBSTC, FREEl ,  FREE2 , FREE3 , START , GOAL 
c  declare  local  variables 

integer  0 

c  write  node  potential  parameters 

write (0, 2000 )  OBSX, OBSC, GND, VCC,  ALLERR, MAXIT,  DIRALL 
2000  format  (/'Node  Potential  Parameters:',// 

2  '  Isolated  obstacle  value  (ObsX)  =  ',f8.4,/ 

3  '  Connected  obstacle  value  (ObsC)  =  ',f8.4,/ 


4 

'  Start  node  value  -  -  -  - 

(Gnd) 

a 

',f8.4,/ 

5 

'  Goal  node  value  -  -  -  - 

(Vcc) 

a 

',f8.4,/ 

6 

'  Max  nodal  change  allowed  per  iter 

m 

',f8.4,/ 

7 

'  Max  number  of  iterations 

allowed 

» 

’,i8,/ 

8 

'  Horiz  directions  allowed 

(4  or  8) 

a 

’,i8/) 

return 

end 

-  +  - 

_ 
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1 
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1 

f 
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1 

1 

1 

1 

1 

1 

1 

t 

1 

1 

1 

1 

1 
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subroutine  UPDATE 

c  allows  user  to  modify  maze/parameter  data 
c  declaration  of  global/common  variables 

integer  SCR,FIL,ROW,COL,DEP,STARTN(3)  ,GOALN(3) 

integer  MAXIT, CNT, MOVE, I, J, K, DIRALL 

real  OBSX,OBSC,GND,VCC,DIST 

real  ALLERR, ACTERR,TTLERR 

integer  WTS<0:81, 0:81,0:9) 

real  POT  (0 : 81, 0: 81,0: 9) 

real  PFLD  (0 : 81, 0 : 81, 0 : 9) 

integer  PATH (0 : 1000, 4) 

character *12  FILEDF,FILEP,FILEM,FILEO 

character*!  MAZ (0:81, 0:81,0:9) 

character*!  OBSTX,OBSTC,  i’k.';El,FREE2,FREE3,  START, GOAL 
common  SCR, FIL, ROW, COL, DEP, STARTS, GOALS, MAXIT, 

CNT, MOVE, I, J, K, DIRALL, OBSX, OBSC,GND, VCC, DIST, 
ALLERR, ACTERR, TTLERR, WTS, 

POT, PFLD, FILEDF, FILEP,  FILEM, FILEO, PATH, 

MAZ, OBSTX, OBSTC, FREEl, FREE2 , FREE3, START, GOAL 
c  declare  local  variables 

character*!  aPD,MOD,NCHAR 

integer  NROW.NCOL,NDEP 

0PD='N' 

c  as)c  if  modification  is  desired 
call  belKl) 
write (*,2000) 

2000  format ( 'Enter  <Y>  to  modify  the  parameters,  or',/ 

+  '  <CR>  to  use  default  parameters  :  ’$) 

read(*,  ' (al) ' )  OPD 
write (*, *) 

if  (UPD.ne.'Y'  .and.  DPD.ne.'y')  goto  8000 
write (*, *) 

1000  MOD='Q' 

write (*, 2010)  (STARTN (I) , 1-1,3) , (GOALN(I) , I-l, 3) , 

+  OBSX, OBSC, GND, VCC, ALLERR, MAXIT, DIRALL, FILEO 

2010  format (/' -  PARAMETER  MODIFICATION  MEND  - ',// 

2  'Enter  character  of  item  to  modify:',// 

3  '  <S>  for  START  node,  currently  at  (',i3, ', ',i3, ', ',i3, ') ',/ 

4  '  <G>  for  GOAL  node,  currently  at  (',i3, ', ’,i3, ', ',i3, ') ',/ 

5  '  <X>  for  OBSX  node  (isolated)  ,  currently  =',f8.4,/ 

6  '  <C>  for  OBSC  node  (connected),  currently  =',f8.4,/ 

7  '  <B>  for  B-GND  (start  node)  pot,  currently  -',f8.4,/ 

8  '  <V>  for  VCC  (goal  node)  pot,  currently  =',f8.4,/ 

9  '  <N>  for  max  NODAL  change  allowed  per  iter  -',f8.4,/ 

+  '  <I>  for  max  number  of  ITERATIONS  allowed  -',18,/ 

1  '  <D>  for  horiz  move-DIRECTIONS  (4  or  8)  =',i8,/ 

2  '  <M>  for  MAZE  element  positioning*,/ 

3  '  <R>  for  RE-SHOW  maze  environment’,/ 

4  '  <0>  for  ODTPDT  file_name,  currently  :  ',al2,// 

5  '  :Q>  or  <CR>  to  QUIT  modification  menu  ! ' ) 

call  bell(l) 

write (*,2020) 
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2020  format ( 'CHOICE  :  '$) 

read(*, ' (al) •)  MOD 

if  (MOD.eq.'Q'  .or.  MOD.eq.'q'  .or.  MOD.eq.'  ’)  then 
goto  8000 

else  if  (MOD.eq. 'S'  .or.  MOD.eq. 's')  then 
call  bell(l) 
write (*, 4010) 

4010  format  ('Enter  new  Start  ROW,COL,DEP  ;  '$) 

reacK',*)  NROW,NCOL,NDEP 
if  (NROW.lt.l  .or.  NROW.gt.ROW  .or. 

2  NCOL.lt.l  .or.  NCOL.gt.COL  .or. 

3  NDEP.lt.l  .or.  NDEP.gt.DEP)  then 
write  (*,*) 

write  (*,■♦) 'Node  mu'  >  between  (  1  -  ',ROW, 

+  '.  1  -  '.COL,  ',  1  -  '.DEP,  ')  ' 

write (*, *) 
write (*, *) 
goto  1000 
end  if 

STARTN(1)=NR0W 
STARTN(2)=NC0L 
STARTN(3)=NDEP 
write (*, *) 
write (*, *) 

else  if  (MOD.eq. 'G'  .or.  MOD.eq. 'g')  then 
call  bell(l) 
write (*, 4020) 

4020  format  ('Enter  new  Goal  ROW.COL.DEP  ;  '$) 

read(*,*)  NROW.NCOL.NDEP 
if  (NROW.lt.l  .or.  NROW.gt.ROW  .or. 

2  NCOL.lt.l  .or.  NCOL.gt.COL  .or. 

3  NDEP.lt.l  .or.  NDEP.gt.DEP)  then 
write (*, *) 

write (*,*) 'Node  must  be  between  (  1  -  '.ROW, 

+  ',  1  -  '.COL,  ',  1  -  '.DEP,  ')  ' 

write  (“,  *) 
write (*, *) 
goto  1000 
end  if 

GOALN(l)=NROW 
GOALN(2)=NCOL 
GOALN(3)=NDEP 
write (*, *) 
write  (*, *) 

else  if  (MOD.eq. 'X'  .or.  MOD.eq. 'x')  then 
call  bell(l) 
write (*, 4030) 

4030  format  ('Enter  new  OBSX  value  :  '$) 

read(*,*)  OBSX 
write (*, *) 
write  (*,  *) 

else  if  (MOD.eq. 'C  .or.  MOD.eq. 'c')  then 
call  bell(l) 
write(*,4040) 

4040  format  ('Enter  new  OBSC  value  ;  '$) 

read(*.*)  OBSC 
write (*, *) 
write (*, *) 

else  if  (MOD.eq. 'B'  .or.  MOD.eq. 'b')  then 
call  bell(l) 
write (*, 4050) 

format  ('Enter  new  GND  value  :  '$) 


4050 
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4060 


4070 


4080 


4090 


4100 


read(*,*)  GND 
write (*, *) 
write (*, *) 

else  if  (MOD.eq. 'V'  .or.  MOD.eq.'v*)  then 
call  belKl) 
write (*, 4060) 

format  ('Enter  new  VCC  value  :  '$) 

read{*,*)  VCC 
write {*, *) 
write (*, *) 

else  if  (MOD.eq. 'N'  .or.  MOD.eq. 'n')  then 
call  bell(l) 
write (*, 4070) 

format  ('Enter  new  MAX  NODAL  value  :  '$) 

read(*.*)  ALLERR 
write (*, *) 
write (*, *) 

else  if  (MOD.eq. 'I'  .or.  MOD.eq. 'i')  then 
call  bell(l) 
write (*, 4080) 

format  ('Enter  new  MAX  #  ITER  value  ;  '$) 

read(»,»)  MAXIT 
write (*,*) 
write (*, *) 

else  if  (MOD.eq. 'M'  .or.  MOD.eq. 'm')  then 
call  bell(l) 
write (*, 4090) 

format  ('Enter  ROW,COL,DEP  of  node  to  be  changed  :  '$) 

read(*,*)  NROW,NCOL,NDEP 
if  (NR0W.lt. 1  .or.  NROW.gt.ROW  .or. 

NCOL.lt.l  .or.  NCOL.gt.COL  .or. 

NDEP.lt.l  .or.  NDEP.gt.DEP)  then 
write (*, *) 

write (*,*) 'Node  must  be  between  (  1  -  ',ROW, 

',  1  -  ',COL,  ',  1  -  •,DEP,  ')  ' 

write (*, *) 
write  (*,  *) 
goto  1000 
end  if 
write  (*,  *) 
write (*, 4100) 

format  ('Enter  CHARacteristic  for  new  node  :  '$) 

read(*, ' (al) ')  NCHAR 
write (*, *) 
write (*, *) 

if (NCHAR. ne.OBSTX  .and.  NCHAR. ne.OBSTC  .and. 

NCHAR. ne.FREEl  .and.  NCHAR. ne.FREE2  .and. 

NCHAR. ne. FREES)  then 

write (*,*) 'CHARacter  must  be  '.OBSTX, '  ,  ',OBSTC, 

'  ,  ',FREE1,'  ,  '.FREES,'  ,  or  '.FREES 

write  (*,*) 
write (*, *) 
else 

MAZ (NROW, NCOL, NDEP) =NCHAR 
end  if 

else  if  (MOD.eq. 'R'  .or.  MOD.eq. 'r')  then 
write (*, *) 
call  MAZOUT(SCR) 
if  (SCR.eq.9)  call  t>ell(l) 

if  (SCR.eq.9)  pause  'press  <CR>  to  continue...  ' 
if  (SCR.eq.9)  write(*,*) 

else  if  (MOD.eq. 'D'  .or.  MOD.eq. 'd')  then 
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call  bell(l) 
write (*, 4110) 

4110  format  ('Enter  new  horiz  move-DIRECTIONS  allowed  :  '$) 

read(*,*)  DIRALL 
write (*, *) 
write  (*,  *) 

if  (DXRALL.ne.S  .and.  DIRALL. ne. 4)  then 
write (*,*) 'DIRALL  must  be  4  or  8* 

DIRALL=4 
write (*, *) 
write  (*,  *) 
end  if 

else  if  (MOD.eq.'O'  .or.  MOD.eq. 'o’  .or.  MOD.eq.'O')  then 
call  hell(l) 
write (*, 4120) 

4120  format  ('Enter  new  OOTPOT  file_name  :  '$) 

read(*,*)  FILED 
write (*, *) 
write (*, *) 
else 

write (»,*)  MOD,'  is  not  a  valid  OPTION...' 
write (*, *) 
write  (*,  *) 
end  if 

7000  goto  1000 

8000  if  (STARTN(l) .It.l  .or.  STARTN(l) .gt.BOW  .or. 

2  STARTN(2) .It.l  .or.  STARTN(2) .gt.COL  .or. 

3  STARTNO)  .It.l  .or.  STARTN(3)  .gt.DEP)  then 
write(*,*) 

write (*,*) 'Start  node  must  be  between  (  1  -  ’,ROW, 

+  1  -  ',C0L, 1  -  •,DEP, ')' 

write  (*,*) 
write  (*,*) 
goto  1000 
end  if 

if  (GOALNd)  .It.l  .or.  GOALN(l)  .gt.ROW  .or. 

2  GOALS(2)  .It.l  .or.  GOALN(2)  .gt .COL  .or. 

3  GOALN(3) .It.l  .or.  GOALN(3) .gt.DEP)  then 
write (*, *) 

write (*,*) 'Goal  node  must  be  between  (  1  -  ’,F0W, 

+  ',  1  -  ',COL, 1  -  •,DEP, ') ' 

write (*, *) 
write (*, *) 
goto  1000 
end  if 

c  set  weights  array 

do  30  K=0,DEP+1 
do  20  J=0,COL+1 
do  10  I=0,ROW+1 

if  (MAZd,  J,K)  .eq.FREEl  .or.  MAZ (I,  J,:<)  .eq.FREF.2  .or. 

+  MAZd,  J,K)  .eq.FREE3  .or.  MAZ  (I,  J,K) -eq.OBSTC)  then 

WTS(I, J,K)=1 
else 

WTS(I,  J,K)  =0 
end  if 

10  continue 

20  continue 

30  continue 

c  open  output  file 

if  (SCR.eq.9)  then 

open(FIL, file-FILEO,  status='NEW’ ) 
else 


open (FIL, f ile-FILEO) 
endif 

write (FIL, 2030)  FILEO 
2030  forme  ('file:  ',al2//) 
call  MAZLGO(FIL) 
c  add  start/goal  data  to  MAZ 

KAZ ( STARTN ( 1 ) , STARTN ( 2 ) , STARTS ( 3 ) ) =START 
MAZ (GOALS ( 1) , GOALS ( 2 ) , GOALS (3) ) =GOAL 

c  add  start/goai  data  to  WTS 

WTS ( STARTS ( 1 ) , STARTS ( 2 ) , STARTN { 3 ) >  =1 
WTS (GOALS (1) , GOALS (2) .GOALS (3)) -I 
8888  return 
end 

c - + - 1 - 2 - 3 - 4 - 5 - 6 - 7 


subroutine  MAZPOT 

c  converts  info  from  char  array  MAZ  to  value  array  POT,  +  init  PFLD 
c  declaration  of  global/common  variables 

integer  SCR, FIL, ROW,COL,DEP, STARTN (3) .GOALS (3) 

integer  MAXIT, CNT, MOVE, I, J, K, DIRALL 

real  OBSX,OBSC,GND,VCC,DIST 

real  ALLERR, ACTERR, TTLERR 

integer  WTS(0;81, 0:81, 0:9) 

real  POT(0:81, 0:81, 0:9) 

real  PFLD(0:81, 0:81,0:9) 

integer  PATH (0 :1000, 4) 

character*12  FILEDF,FILEP,FILEM, FILEO 

character*!  MAZ (0:81,0:81,0:9) 

character*!  OBSTX, OBSTC,FREEl,FREE2,  FREE3,  START, GOAL 

common  SCR, FIL, ROW, COL, DEP, STARTN, GOALS, MAXIT, 

2  CNT, MOVE, I, J,K, DIRALL,  OBSX, OBSC.GND, VCC, DIST, 

3  ALLERR, ACTERR, TTLERR, WTS, 

4  POT, PFLD, FILEDF, FILEP, FILES, FILEO, PATH, 

5  MAZ, OBSTX, OBSTC, FREEl, FREE2 , FREE3, START, GOAL 
c  declare  local  variables 


character*!  TEMP 
integer  0 

do  40  K=0,DEP+1 
do  30  I=0,ROW+1 
do  20  J=0,COL+1 
TEMP=MAZ(I,  J,  K) 
if  ( TEMP. eq. OBSTX)  then 

POT(I,J,K)  =  OBSX 
else  if  (TEMP, eq, OBSTC)  then 
POT(I,J,K)  -  OBSC 

else  if  (TEMP. eq. FREEl  .or,  TEMP . eq . FREE2  .or. 

+  TEMP. eq. FREES)  then 

POT(I,J,K)  -  GND 
else  if  / TEMP. eq, START)  then 
POT(I,J,K)  =■  GND 
else  if  (TEMP  eq.GOAL)  then 
POT(I,J,K)  -  VCC 
else 

POT(I,J,K) =OBSX 
do  10  0=FIL,SCR  ,SCR-FIL 
write (D,*) 

write  (0,2000)  TEMP,I,J,K 

2000  format (/ 'Error  while  assigning  values  to  maze,',/ 

2  'un]cnown  character  entry  :  ',al. 
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3  '  .  at 

4  ' (entry  set  to  Isolated  obstacle  value) '//) 

10  continue 

end  if 

20  continue 

30  continue 

40  continue 

c  initialize  array  PFLD  outer  boundaries  to  obstacle  values 
c  init  top  and  bottom  of  array 
do  60  J=0,COL+1 
do  50  I=0,ROW+1 
PFLDd,  J,0)=OBSX 
PFLDd,  J,DEP+1)=0BSX 
50  continue 

60  continue 

c  init  sides  of  array 
do  90  K-1,DEP 
do  70  J-0,COL+1 
PFLD(0,  J,K)«=0BSX 
PFLD (ROW+1, J, K) “OBSX 
70  continue 

do  80  I»1,R0W 

PFLDd,0,K)=OBSX 
PFLD ( I , COL+1 , K) -OBSX 
80  continue 

90  continue 

return 
end 

c - + - 1 - 2 - 3 - 4 - 5 - 6 - 7 


subroutine  MAZFLD 

c  calculate  final  values  for  potential  field  array 
0  and  show  in  progress  error  calculations 
c  declaration  of  global/common  variables 

integer  SCR,FIL,RC3W,COL,DEP,STARTN(3)  ,G0ALN(3) 

integer  MAXIT,CNT,MCVE,If Jf K,DIRALL 

real  OBSX,OBSC,GND,VCC,DIST 

real  ALLERR,ACTERR,TTLERR 

integer  WTS(0;81, 0:81, 0:9) 

real  POT(0;81, 0:81, 0:9) 

real  PFLD(0:81, 0:81,0:9) 

integer  PATH (0:1000, 4) 

character*12  FILEDF,FILEP,FILEM,FILEO 

character*!  MA2(0:81, 0:81, 0:9) 

character* 1  OBSTX, OBSTC, FREEl, FREE2,  FREE3, START, GOAL 

common  SCR, FIL, ROW, COL, DEP, STARTN, GOALN, MAXIT, 

2  CNT,  MOVE, I, J, K, BIRALL, OBSX, OBSC, GND, VCC, DIST, 

3  ALLERR,ACTERR,TTLERR,WTS, 

4  POT, PFLD, FILEDF, FILEP,  FILEM, FILEO, PATH, 

5  MA2, OBSTX, OBSTC, FREEl,  FREE2 , FREE3, START, GOAL 
c  declare  local  variables 


integer  PINTVL,PRNCNT,ITGLOP 

real  SOM, ERROR, INVSR2 , SNWTS 

character*!  GBLANS 
INVSR2  =1.0  /  sqrt(2.0) 

ITGLOP-0 

PINTVL=10 


write  (*,*) 

write(*,*)  'Node  Potential  Array  Iteration/Error  Status;  ' 
write  (■*,*) 

CNT=1 
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PRNCNT=PINTVL-1 
ACTERR-0.0 
TTLERR-0 . 0 
do  60  K=1,DEP 
do  50  I-l,ROW 
do  40  J-l,COL 

if  (MAZ(I,  J,K)  .eq.FREEl  .or.  MAZ  ll,  J,  K)  ,eq.FREE2  .or. 

MAZd,  J,K)  .eq.FREE3)  then 
if (DIRALL.eq.4)  then 

SNWTS  =•  WTS(I-1,J,K)  +  WTS(I,J+1,K)  +  WTS(I+1,J,K) 

+  WTS(I,J-1,K)  +  WTS(I,J,K-1)  +  WTS(I,J,K+1) 

else 

SNWTS  =  WTS(I-1,J,K)  +  WTS(I,J+1,K)  +  WTS(I+1,J,K) 

+  WTS(I,J-1,K)  +  WTS(I,J,K-1)  +  WTS<I,J,K+1) 

+  (  WTS(I-1,J+1,K)  +  WTS(I+1, J+1,K) 

+  WTS(I+1,J-1,K)  +  WTS(I-1, J-1,K) )  *  INVSR2 

endif 

if  (SNWTS  .eq.  0.0)  then 

PFLD(I,J.K)  =  P0T(I,J.K) 
else 

if (DIRALL.eq. 4)  then 

SUM  =  POT(I-l,J,K)  *  WTS(I-1.J,K) 

+  POT{I,J+l,K)  *  WTS(I,J+1,K) 

+  POT(I+l,J,K)  *  WTS(I+1,J.K) 

+  POT(I,J-l,K)  *  WTS(I,J-1,K) 

+  POT{I,J,K-l)  »  WTS(I,J,K-1) 

+  POT(I,  J,K+1)  *  WTS(I.J,K+1> 

else 

SOM  »  POT(I-l,J,K)  »  WTS(I-1,J,K) 

+  P0T(I,J+1,K)  *  WTS(I,J+1,K) 

+  P0T(I+1,J,K)  *  WTS(I+1,J,K) 

+  POT(I,J-l,K)  •  WTS(I,J-1,K) 

+  POT(I,J,K-l)  *  WTS(I,J,K-1) 

+  P0T(I,J,K+1)  *  WTS(I,J,K+1) 

+  (  POT<I-l,J+l,K)  *  WTS(I-1, J+1,K) 

+  POT(I+l,J+l,K)  *  WTS{I+1,  J+1,K) 

+  POT(I+l,J-l,K)  *  WTS{I+1, J-1,K) 

+  POT{I-l,J-l,K)  •  WTS{I-1,J-1,K))  *  INVSR2 

endif 

PFLD(I,J,K)  -  SUM  /  SNWTS 
end  if 


c 

c 


ERROR-ABS  (PFLD  ( I,  J,  K)  -POT  (I,  J,  K)  ) 
TTLERR-TTLERR+EBROR 
if  (ERROR. gt.ACTERR)  ACTERR=ERROR 
check  if  neighbors  of  3T.ART  PT  show  “potential  change" 
thus  indicating  first  path  found  between  COAL  and  START!!! 

else  if  (ITGLOP.eq.O  .and.  MAZ (I, J, K) .eq.START)  then 
PFLD  ( I ,  J,  K)  -POT  ( I,  J,  K) 
if (DIRALL.eq. 4)  then 


2 

3 

4 

5 
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SOM  =  POT(I-l,J,K)  *  WTS(I-1,J,K) 

+  P0T(I,J+1,K)  *  WTS(I,J+1,K) 
+  POT(I+l,J,K)  *  WTS(I+1,J,K) 
+  POT(I,J-l,K)  •  WTS(I,J-1,:<) 
+  P0T(I,J,K-1)  *  WTS(I,J,K-1) 
+  POT(I,J,K+l)  *  WTS(I,J,K+1) 


else 


2 

3 

4 

5 
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SOM  »  P0T{1-1,J,K)  •  WTS(Z-1,J,K) 

+  POT(I,J+l,K>  *  WTS(I,J+1,K) 
+  PQT(I+1,J,K)  •  WTS{I+1,J,K) 
+  POT(I,J-l,K)  *  WTS(I,J-1.K) 
+  POT(I,J,K-l)  *  WTS<I.J,K-i) 
+  POT(I,J,K+l)  *  HTS(I,J,K+1) 
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7  +  (  P0T{X-1,  J+1,K)  *  WTS(I-1,  J+1,K) 

8  +  P0T(I+1,  J+1,K>  *  WTS(I+1,  J+1,K) 

9  +  P0T(I+1,  J-1,K)  *  WTS(I+1,  J-1,K) 

+  +  P0T(I-1,  J-1,K)  *  WTS(I-1,  J-1,K)  )  *  INVSR2 

endlf 

if  (SOM.gt.GND)  then 
ITGLOP=CNT 

write (SCR, 2000)  ITGLOP 
write (FIL, 2000)  ITGLOP 

2000  format (//'Global  minimal  distance  solution  found 

+  'using', 15,'  iterations!!!'/) 

call  bell(l) 
write(*,2010) 

2010  format ( 'Enter  <Y>  to  continue  iterating,  or',/6x, 

+  '<CR>  to  compute  path  with  current  nodal  values :'$) 

GBLANS= '  ' 

read!*,  '  (al) ')  GBLANS 
write (*, *) 

if  (GBLANS.ne. 'Y'  .and.  GBLANS. ne. 'y' )  goto  100 
endif 
else 

PFLDd,  J,K)=POT(I,  J,K) 
end  if 

40  continue 

50  continue 

60  continue 

do  90  K=0,DEP+1 
do  80  I-0,ROW+1 
do  70  J=0,COL+1 

POT(I,  J,K) -PFLDd,  J,K) 

70  continue 

80  continue 

90  continue 

PRNCNT-PRNCNT+1 
if  (PRNCNT.eq.PINTVL)  then 

write (*, 2020) CNT, ACTERR, TTLERR 
2020  format (' Iter ;', 14, 5x, 'Max  nodal  chg  -  ',f7.4, 

+  5x, 'Total  iter  chg  -  ',f8.4) 

PRNCNT-0 

if  (CNT.eq.l)  PRNCNT-1 
end  if 

if  (CNT.ge.MAXIT)  goto  100 
CNT-CNT+1 

if  ( ACTERR. gt.ALLERR)  goto  10 
100  return 

end 

c - + - 1 - 2 - 3 - 4 - 5 - 6 - 7 

subroutine  MAZFNL(O) 
c  outputs  potential  field 

c  declaration  of  globai/common  variables 

integer  SCR, FIL, ROW, COL,DEP, STARTN (3) , GOALN (3) 

integer  MAXIT, CNT, HOVE, I, J, K, DIRALL 

real  OBSX,OBSC,GND,VCC,DIST 

real  ALLERR, ACTERR, TTLERR 

integer  WTS <0:81, 0:81, 0:9) 

real  POT(0:81, 0:81,0:9) 

real  PFLD(0:81, 0:81,0:9) 

integer  PATH(0:1000,4) 

character *12  FILEDF, FILEP, FILEM, FILEO 

character*!  MAZ{0:81, 0:81, 0:9) 


c 

c 


character*! 

common 

2 

3 

4 

5 


OBSTX , OBSTC , FREE! , FREE2 , FREE3 , START , GOAL 
SCR, FIL, ROW, COL, DEP, STARTN, GOALN, MAXIT, 

CNT, MOVE, I, J, K, DIRALL, OBSX, OBSC, GND, VCC, DIST, 
ALLERR, ACTERR, TTLERR, WTS , 

POT, PFLD, FILEDF, FILEP, FILEM, FILEO, PATH, 

MAZ, OBSTX, OBSTC, FREE!, FREE2 , FREE3 , START , GOAL 


declare  local  variables 


integer  0 

output  potentials  array 
write  (CJ,  *) 

write (U,*)  'Final  Nodal  Potentials..,  ' 
write (0, *) 
do  20,  K=1,DEP 

if  (DEP.ne.l)  then 
write  (0,  *) 

write (0,*)  'Depth  Layer: ',K 
endif 


do  10,  1=1, ROW 

write  (0,2000)  (POTd,  J,K)  ,  J=l,COL) 
2000  format  (128ell.3) 

10  continue 

20  continue 

write  (0,*) 

return 

end 


c - + - 1 - 2 - 3 - 4 - 5 - 6 - 7 


subroutine  MAZMOV 
c  calculate  path 

c  declaration  of  global/common  variables 

integer  SCR, FIL, ROW, COL, DEP, STARTN (3) ,GOALN(3) 

integer  MAXIT, CNT, MOVE, I, J, K, DIRALL 

real  OBSX, OBSC, GND, VCC, DIST 

real  ALLERR, ACTERR, TTLERR 

integer  WTS(0:81, 0:81, 0:9) 

real  POT(0:81, 0:81, 0:9) 

real  PFLD(0:81, 0:81,0:9) 

integer  PATH (0:1000, 4) 

character *12  FILEDF, FILEP, FILEM, FILEO 

character*!  MAZ (0 : 81, 0 : 81,0: 9) 

character*!  OBSTX, OBSTC, FREEl, FREE2, FREE3,  START,  GOAL 

common  SCR, FIL, ROW, COL, DEP, STARTN, GOALN,  MAXIT, 

2  CNT, MOVE, I , J, K, DIRALL, OBSX, OBSC, GND, VCC, DIST, 

3  ALLERR, ACTERR, TTLERR,  WTS, 

4  POT,  PFLD, FILEDF, FILEP, FILEM, FILEO, PATH, 

5  MAZ , OBSTX , OBSTC, FREEl , FREE2 , FREE3 , START , GOAL 
c  declare  local  variables 

integer  L,RC,CLOC  (3)  ,NLOC(3)  ,MKR 

real  SR2,CNODE,DN,DE,DS,DW,DD,DD,DNE,DSE,DSW,DNVJ,MAXD 

SR2=sqrt(2.0) 

c  initialize  array  PATH  to  all  zeros 
do  20  RC=1,4 
do  10  L=l,1000 
PATH(L,RC)=0 
10  continue 

20  continue 

c  set  MOVE  to  0,  and  MKR  to  ASCII  char  code  for  'O' 

MOVE-0 

DIST=0.0 

MKR=48 

c  set  current  location 


CL0C(1)=STARTN(1) 

CL0C{2)=STARTN(2) 

CLOC(3)=STARTN(3) 
c  set  path  start 

PATH  (0,1) -STARTN(l) 

PATH(0,2)=STARTN(2) 

PATH(0,3)=-'TARTN(3) 

30  if  (CLOC(l)  .eq.GOALN(l)  .and.  CLOG (2)  .eq.GOALN (2) 

+  .and.  CLOC(3)  .eq.GOALH<3) )  then 

PATH (MOVE, 4 )=0 
goto  8888 
end  if 

CNODE  =  PFLD(CLOC(l)  ,CLOC(2),CLOC(3)  ) 
c  cal  delta  potentials  for  North,  East,  South,  West,  Op,  &  Down 
DN  =  PFLD(CLOC(l)-l,CLOC{2),CLOC(3))-CNODE 
DE  =  PFLD(CLOC(l),CLOC{2)+l,CLOC(3))-CNODE 
DS  =  PFLD(CLOC(l)+l,CLOC(2),CLOC{3)) -CNODE 
DW  =  PFLD (CLOG (1), CLOG (2) -1, CLOG (3)) -CNODE 
DO  =  PFLD(CL0C(1),CL0C(2),CL0C(3)-1)-CN0DE 
DD  =  PFLD(CLOC(l),CLOC(2),CLOC{3)+l)-CNODE 
if  (DIRALL.eq.4)  goto  40 

c  calculate  delta  potentials  for  NE,  SE,  SW,  £  NW 

DNE  =  (PFLD(CLOC(l) -l,CLOC(2)+l,CLOC(3)  ) -CNODE)  /  SR2 
DSE  -  (PFLD{CLOC(l)+l,CLOC(2)+l,CLOC(3)  )-CNODE)  /  SR2 
DSW  •=  (PFLD(CLOC(l)+l,CLOC(2)-l,CLOC(3)  )-CNODE)  /  SR2 
DNW  =  (PFLD(CLOC(l)-l,CLOC(2)-l,CLOC(3)  ) -CNODE)  /  SR2 
MAXD  =  MAX(DN,DE,DS,DK,DO,DD,DNE,DSE,DSW,DNW) 
goto  50 

40  MAXD  =  MAX(DN,DE,DS,DW,DO,DD) 

c  check  for  no  solution 
50  if  (MAXD  .le.  0.0)  then 

write (SCR, 2000) 
write (FIL, 2000) 

2000  fonnat(/'!!  No  solution  ^ound  for  this  problem  !!',/ 

+  ' (allow  more  iterations  or  look  for  blocked  path) ’//) 

PATH (MOVE, 4) =  -1 
goto  8888 
end  if 

c  check  N  move 

if  (MAXD.eq.DN)  then 
NLOC(l)=CLOC(l)-l 
NLOC(2)=CLOC(2) 

NLOC(3)=CLOC(3) 

PATH (MOVE, 4) =1 
DIST=DIST+1.0 
goto  60 

c  check  E  move 

else  if  (MAXD.eq.DE)  then 
NLOC(l)=CLOC(l) 

NLOC(2)=CLOC(2)+l 

NLOC(3)=CLOC(3) 

PATH (MOVE, 4) =2 
DIST=DIST+1.0 
goto  60 

c  check  S  move 

else  if  (MAXD.eq.DS)  then 
NLOC(l)=CLOC(l)+l 
NLOC(2)=CLOC(2) 

NLOC(3)=CLOC(3) 

PATH (MOVE, 4) -3 
DIST>=DIST+1.0 
goto  60 
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c  check  W  move 

else  if  (MAXD.eq.DW)  then 
NLOC(l)“CLOC(l) 
NLOC(2)=CLOC(2)-l 
NLOC(3)=CLOC(3) 

PATH (MOVE, 4) =4 
DIST-DIST+1.0 
goto  60 

c  check  0  move 

else  if  (MAXD.eq.DO)  then 
NLOC(l)=CLOC(l) 
NLOC(2)=CLOC(2) 
NLOC(3)=CLOC(3)-l 
PATH (MOVE, 4) =10 
DIST=DIST+1.0 
goto  60 

c  check  D  move 

else  if  (MAXD.eq.DO)  then 
NLOC(l)=CLOC(l) 
NLOC(2)=CLOC(2) 
NLOC(3)=CI.OC(3)+l 
PATH (MOVE, 4) =20 
DIST=DIST+1.0 
goto  60 
end  if 

c  check  HE  move 

if  (MAXD.eq.DNE)  then 
NLOC(l)=CLOC(l)-l 
NLOC(2)=CLOC(2)+l 
NLOC(3)=CLOC(3) 

PATH (MOVE,  4 )=S 
DIST=DIST+SR2 
c  check  SE  move 

else  if  (MAXD.eq.DSE)  then 
NLOC(l)=CLOC(l)+l 
NLOC(2)-CLOC(2)+l 
NLOC(3)=CLOC(3) 

PATH (MOVE, 4) =6 
DIST=DIST+SR2 
c  check  SW  move 

else  if  (MAXD.eq.DSW)  then 
NLOC(l)=CLOC(l)+l 
NLOC(2)=CLOC(2)-l 
NIX)C(3)=CLOC(3) 

PATH (MOVE, 4) -7 
DIST=DIST+SR2 
c  check  NW  move 

else  if  (MAXD.eq.DNW)  then 
NLOC(l)=CLOC(l)-l 
NLOC(2)=CLOC(2)-l 
NLOC(3)=CLOC(3) 

PATH (MOVE, 4) =8 
DIST=DIST+SR2 
end  if 

60  MOVE=MOVE+l 
MKR-MKR+1 

if  (MKR.eq.53)  MKR=48 
CL0C(1)=NL0C(1) 
CLOC(2)=NLOC{2) 
CL0C(3)=NL0C(3) 

PATH (MOVE, l)=CLOC(l) 
PATH(MOVE,2)=CLOC(2) 
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PATH (MOVE , 3 ) =CLOC ( 3 ) 

if  (CLOC(l)  .ne.GOALN(l)  .or.  CLOC(2>  .ne.GOALN(2) 

2  .or.  CLOC(3)  .ne.GOALN(3) ) 

3  MAZ{CLOC(l),CLOC(2).CLOC(3))  -  char  (MKR) 
goto  30 

8883  return 
end 

subroutine  MAZPTH(U) 
c  output  path 

c  declaration  of  global/common  variables 

integer  SCR,FIL,ROW,COI.,DEP,STARTN(3)  ,GOALN(3) 

integer  MAXIT, CNT,MOVE, I, J, K, DIRALL 

real  C  ■;SX,OBSC,GND,VCC,DIST 

real  ALLERR, ACTERR, TTLERR 

integer  WTS (0:81, 0:81, 0:9) 

real  POT(0:81, 0:81, 0:9) 

real  PFI,D(0:81, 0:81, 0:9) 

integer  PATH(0:1000,4) 

character*12  FILEDF, FILEP, FILEM, FILED 

character*!  MA2 (0:81,  0:81,0:9) 

character*!  OBSTX, OBSTC,  FREEl, FREE2,  FREES, START, GOAL 

common  SCR, FIL, ROW,  COL, DEP, STARTN, GOALN, MAXIT, 

2  CNT, MOVE, I, J, K, DIRALL,  OBSX,  OBSC, GND, VCC, DIST, 

3  ALLERR, ACTERR, TTLERR,  WTS, 

4  POT, PFLD, FILEDF, FILEP,  FILEM, FILED, PATH, 

5  MAZ , OBSTX, OBSTC, FREEl ,  FREE2 ,  FREE3 , START, GOAL 
c  declare  local  variables 

integer  STEP,0 

character*4  MAZDIR 

write (0,2000)  MOVE, DIST 

2000  format (/, 'Solution  Path...  ’, 

2  '  Path  =*,i4,'  steps, ’,  f8.2, '  units',// 

3  '  Step  Current  Node  Next  Move ' , / 

4  '  Number  (  Row,  Col,  Depth)  Direction'/) 
c  output  STEP  ROW  COL  DEPTH  DIRECTION 

write(0,2010)  '  START  PT' ,PATH(0, 1)  ,PATH (C, 2) , PATH (0, 3) , 

+  MAZDIR(PATH(0,4) ) 

2010  format  (a9, 3x, ' ( ' , i3, '  ,',i3,'  ,’,i3,'  )',6x,a4) 

if  (MOVE.oq.O)  goto  20 
do  10  STEP=l,MOVE 

write(U,2020)  STEP, PATH (STEP, 1) , PATH (STEP, 2) , PATH (STEP, 3) , 

+  MAZDIR (PATH (STEP,  4)) 

2020  format  (i5, 7x, ' ( ' , i3, •  ,',i3,'  ,',i3,'  ;’,6x,a4) 

10  continue 

20  write  (U,*) 

return 
end 

c - + - 1 - 2 - 3 - 4 - 5 - 6 - 7— 

function  MAZDIR (IDIR) 

c  produces  direction  character  string  from  integer  input 
character*4  MAZDIR 
integer  IDIR 

if  (IDIR.eq.l)  then 

MAZDIR='  N  ' 
else  if  (IDIR.eq.2)  then 
MAZDIR>='  E  ' 
else  if  (IDIR.eq.3)  then 
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MAZDIR='  S  ■ 
else  if  (IDIR.eq.4)  then 
MAZDIR='  W  ' 
else  if  (IDIR.eq.5)  then 
MAZDIR='  NE  ' 
else  if  (IDIR,eq.6)  then 
MAZDIR='  SE  ' 
else  if  (IDIR.eq.7)  then 
MAZDIR='  SW  ■ 
else  if  (IDIR.eq.8)  then 
MAZDIR-'  NW  • 
else  if  (IDIR.eq.lO)  then 
MAZDIR='  OP  ' 
else  if  (IDIR.eq.20)  then 
MAZDIR='DOWN' 
else  if  (IDIR.eq.O)  then 
MAZDIR='GOAL' 
else 

MAZDIR-'  ??  ' 
end  if 
return 
end 

c - + - 1 - 2 - 3 - 4 - 5 - 6 - 7 

subroutine  bell(NUM) 
c  rings  bell  NUM  times 
c  declare  local  variables 

integer  NOM, RINGS, DELAY 

c  ASCII  code  7  =  bell  ring 
do  20  RINGS-l,NOM 
write (*,*)  char (7) 
c  delay  loop 

do  10  DELAY=1,8000 
10  continue 

20  continue 
return 
end 


amazSd.prf 
(preferences  data  file) 

SCR  (screen  device  output  number)  (use  6  for  SONs) 
FILEDF  (default  input  parameter  file-name) 


9 

bldgnav.par 
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Appendix  G 

AMAZ3D  Test  Data  and  Output 


The  following  output  listings  show  some  of  the  capabilities  of  the  AMAZ3D 
program.  The  first  two  example  problems,  conq)rised  of  six  files  total,  arc  complete:  1) 
maz.par  and  2)  maz,dat  are  the  parameter  and  sensory  data  files  for  the  same  two- 
dimensional  (2D)  maze  solved  by  the  Maze  Machine  in  Appendix  E  as  Test  4,  and  3) 
maz.out  is  the  AMAZ3D  output  Hsting  for  this  problem  (Note  the  similarity  in  final  nodal 
values  for  the  connectionist  network  and  the  identical  path  solutions.),  4)  maz3d.par, 
and  5)  maz3d.dat  are  the  parameter  and  sensory  data  files  for  a  three-dimensional  (3D)  7 
row,  by  7  column,  by  7  layer  maze,  and  6)  maz3d.out  is  the  program's  output  listing  for 
this  example. 

In  an  effort  at  brevity,  no  other  parameter  or  sensory  data  files,  nor  the  AMAZ3D 
standard  logo  at  the  beginning  of  output  listings,  are  included.  Since  aU  the  pertinent 
parameter  and  sensory  data  information  is  included  in  the  program's  output  listing,  no  loss 
of  understanding  should  occur.  The  remaining  sample  output  listings  and  their  significance 
are  as  follows: 

File:  mazno.out  shows  a  7  by  7, 2D  maze  which  results  in  a  non-optimal  (in 
terms  of  minimal  distance)  solution  path.  The  reason  for  the  path  diversion  is  a  fork  in  the 
shortest  distance  path  which  combines  with  an  alternative  path  near  the  start  to  cause  the 
alternate  Conger)  path  to  iiutially  show  a  greater  nodal  value  increase  for  the  first  step  East 
as  opposed  to  West  (Remember  that  the  solution  path  is  based  on  locally  optimal  moves.) 

File:  maznoc.out  (using  iteration  cut-off  feature)  shows  the  same  7  by  7, 2D  maze 
as  mazno.out,  however  this  time  the  feature  of  iteration  cut-off  for  faster  solutions  is 
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implemented.  (Note  a  path  length  of  14  units  as  opposed  to  16  for  the  mazno.out  solution. 
This  solution  happens  to  provide  the  optimal  path  for  this  problem.) 

File:  mazn.out  shows  a  15  by  17, 2D  maze  which  results  in  an  optimal  (in  terms 
of  minimal  distance)  solution  path. 

File:  maznc.out  (using  iteration  cut-off  feature)  shows  the  same  15  by  17, 2D 
maze  as  mazn.out,  however  this  time  the  feature  of  iteration  cut-off  for  faster  solutions  is 
implemented.  (Note  a  path  length  of  45  units  as  opposed  to  43  for  the  mazn.out  solution.) 
This  solution  happens  to  be  sub-optimaL  The  reason  for  the  path  diversion  is  the  large  free 
space  near  /  on  the  optimal  path  which  causes  the  nodes  in  this  region  to  have  smaller  nodal 
values  during  early  iterations  due  to  dispersion,  while  the  isolated  longer  path  is  not 
influenced  by  any  neighboring  free  space  nodes. 

File:  landnav.out  shows  a  44  by  64,  2D  land  navigation  problem  implementing 
the  connected  obstacles  feature.  The  data  for  this  example  was  provided  by  Peter  Weiland 
from  research  he  conducted  on  using  scanning  lasers  for  robotic  navigation  [see  Weiland 
(1989)].  The  data  depicts  processed  local  terrain  sensory  input  from  a  cross-country 
mobL’e  robot.  In  this  example,  it  is  assumed  to  be  desirable  to  avoid  the  two  'round' 
obstacles  and  the  West  side  wall  while  traveling  from  start  to  goal.  Here,  connected 
obstacles  are  obstacles  to  be  avoided,  while  isolated  obstacles  represent  shadow  regions. 
(Note  the  different  behavior  due  to  the  connected  obstacles.)  The  extension  of  using 
connected  obstacles  as  'repulsive  potential  fields'  was  inspired  by  the  work  done  by 
Norwood  (1989). 

File:  landnavc.out  (using  iteration  cut-off)  shows  the  same  44  by  64, 2D  maze  as 
landnav.out,  however  this  time  the  feature  of  iteration  cut-off  is  implemented.  (Notes:  1) 
Diagonal  moves  have  a  unit  value  of  ->  square  root  of  2.  2)  This  run  results  in  a  path 
length  of  44.14  units  as  opposed  to  46.63  for  the  landnav.out  solution.) 


File:  bldgnav.out  shows  a  30  by  80, 2D  building  interior  navigation  problem. 
The  objective  is  to  efficiently  move  from  one  room  to  another  while  travelling  through 
hallways  as  necessary.  Doors  are  shown  differently  from  regular  free  space  nodes  to 
highlight  the  fact  that  this  program  could  be  easily  used  to  control  a  mobile  robot  where  the 
program  calls  on  additional  routines  which  allow  the  robot  to  properly  open  and  close 
doors  during  its  travels. 

File;  b3dnav.out  shows  a  3D  problem  similar  to  the  30  by  80  building  interior,  of 
bldgnav.out,  however  this  time  a  second  story  is  implemented  through  the  addition  of  an 
elevator  in  the  North-East  comer  of  the  floorplan.  Layer  2  is  used  as  a  divider  between  the 
first  and  second  stories/  floors,  thus  causing  this  implementation  to  use  3  layers. 
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maz.par 


7 

ROW 

(maze  i  elm) 

7 

COL 

(maze  j  dim) 

1 

DEP 

(maze  k  dim) 

X 

OBSTX 

(character  representation) 

a 

OBSTC 

(character  representation) 

, 

FREEl 

(character  representation) 

D 

FREE2 

(character  representation) 

E 

FREE3 

(character  representation) 

S 

START 

(character  representation) 

G 

GOAL 

(character  representation) 

7 

STARTN(i) 

(start  i  coord) 

2 

STARTS  (j) 

(  "  j  coord) 

1 

STARTS (k) 

(  "  k  coord) 

1 

GOALS (i) 

(  goal  i  coord) 

7 

GOALS  (j) 

(  ”  j  coord) 

1 

GOALS (k) 

(  "  k  coord) 

0.0 

OBSX 

(forced  potential  value  for  ObstX) 

0.0 

OBSC 

(forced  potential  value  for  ObstC) 

0.0 

GND 

(forced  potential  val'ie  for  Start) 

10.0 

VCC 

(forced  potential  value  for  Goal  ) 

0.0001 

ALLERR 

(max  node  change/iter  allowed) 

3000 

MAXIT 

(max  i  of  iterations  allowed) 

maz .dat 

FILEM 

(maze  input  file)  (12  char  max) 

maz .out 

FI  LEO 

(data  output  file)  (12  char  max) 

4 

DIRALL 

(2D  move-directions  allowed,  4  or 

Maz.dat 

X . 

. ,x,xxx 

.X _ X 

XXX. X. . 

_ XX. 

.xx.x. . 


file:  maz.out 


%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% 
%  % 


%  A 

M 

M 

A  ZZZZZ 

333 

ODDD 

% 

%  A  A 

MM 

MM 

A  A  Z 

3 

D  D 

% 

%  AAAAA 

M  M 

M  M 

AAAAA  Z 

33 

D  D 

% 

%  A  A 

M 

M  M 

A  A  Z 

3 

D  D 

% 

%  A  A 

M 

M 

A  A  ZZZZZ 

333 

DDDD 

% 

• 

%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*%%%%%%%%%%%%% 

Chris  Schuster 

MEMS/Robotics,Rice  University 

v6. 

03 

Maze  Environment. . . 

The  Maze:  maz.dat  has  7  Rows  ,  7  Cols  ,  1  Depth  Layer (s) 


Key:  Obstacles  =  X  (isolated)  0  (connected) 

Free  Space  =  .  (  +  D  (doors)  ,  E  (elevators)  ) 

Start  node  »  S  ,  at  (  7,  2,  1) 

Goal  node  =  G  ,  at  (  1,  7,  1) 

1234567 

1  X . G 

2  ..X.XXX 

3  .X _ X 

4  XXX. X.. 

5  XX. 

6  .XX.X.. 

7  .S . 

Node  Potential  Parameters: 


Isolated  obstacle  value  (ObsX)  = 
Connected  obstacle  value  (ObsC)  = 
Start  node  value  -  -  -  -  (Gnd)  - 
Goal  node  value  -  -  -  -  (Vcc)  = 
Max  nodal  change  allowed  per  iter  = 
Max  number  or  iterations  allowed  = 
Horiz  directions  allowed  (4  or  8)  = 


0.0000 

0.0000 

0.0000 

10.5300 

0.0010 

2000 

4 


Global  minimal  distance  solution  found  using  11  iterations!!! 


Final  Nodal 

Potentials. 

O.OOOE+00 

0.682E+01 

0.682E+01 

0.683E+01 

0.806E+01 

0. 930E+01 

0.105E+02 

0.682E+01 

0.682E+01 

O.OOOE+00 

0.560E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.682E+01 

O.OOOE+00 

0.437E+01 

0.437E+01 

0.405E+01 

0.374E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.346E+01 

O.OOOE+00 

0.343E+01 

0.311E+01 

0.127E+01 

0.170E+01 

0.212E+01 

0.255E+01 

O.OOOE+OO 

O.OOOE+00 

0.280E+01 

0.847E+00 

O.OOOE+00 

O.OOOE+00 

0.206E+01 

O.OOOE+00 

0.234E+01 

0.249E+01 

0.424E+00 

O.OOOE+00 

0.788E+00 

0.158E+01 

0.188E+01 

0.219E+01 

0.234E+01 

104 

Total  Iterations  “  371 

Maximum  individual  nodal  change  0.0010 

Total  iteration  nodal  change  =  0.0127 


Solution  Path...  Path  =  11  steps,  11.00  units 

Step  Current  Node  Next  Move 

Number  (  Row,  Col,  Depth)  Direction 


START  PT 

(  7 

/ 

2 

/ 

1  ) 

E 

1 

(  7 

t 

3 

/ 

1  ) 

E 

2 

(  7 

/ 

4 

t 

1  ) 

N 

3 

(  6 

/ 

4 

$ 

1  ) 

N 

4 

(  5 

/ 

4 

t 

1  ) 

N 

5 

(  4 

/ 

4 

/ 

1  ) 

N 

6 

(  3 

t 

4 

1  ) 

N 

7 

(  2 

$ 

4 

f 

1  ) 

N 

8 

(  1 

t 

4 

/ 

1  ) 

£ 

9 

(  1 

t 

5 

/ 

1  ) 

E 

10 

(  1 

$ 

6 

/ 

1  ) 

E 

11 

(  1 

t 

7 

/ 

1  ) 

GOAL 

Maze  Solution. . . 

The  Maze:  maz.dat  has  7  Rows  ,  7  Cols  ,  1  Depth  Layer (s) 

Key:  Obstacles  «•  X  (isolated)  ,  0  (connected) 

Free  Space  =  .  (  +  D  (doors)  ,  E  (elevators)  ) 

Start  node  =  S  ,  at  (  7,  2,  1) 

Goal  node  =  G  ,  at  (  1,  7,  1) 

1234567 

1  X..890G 

2  ..X7XXX 

3  .X.6..X 

4  XXX5X.. 

5  ...4XX. 

6  .XX3X.. 

7  .S12... 


w  o 
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7 

7 

7 

X 

@ 


S 

G 

3 

3 

1 

3 
5 
7 

0.0 

0.0 

0.0 

10.0 

0.01 

150 

maz3d.dat 
maz3d. out 

4 


ROW 

COL 

DEP 

OBSTX 

OBSTC 

FREEl 

FREE2 

FREE3 

START 

GOAL 

STARTN(i) 

SIARTNC  j) 

STARTN(k) 

GOALN(i) 

GOALN(  j) 

GOALNOc) 

OBSX 

OBSC 

GND 

VCC 

ALLERR 

MAXIT 

FILEM 

FILEO 

DIRALL 


maz.3d.par 

(maze  i  dim) 

(maze  j  dim) 

(maze  k  dim) 

(character  representation) 

(character  representation) 

(character  representation) 

(character  representation) 

(character  representation) 

(character  representation) 

(character  representation) 

(start  i  coord) 

(  "  j  coord) 

(  ”  k  coord) 

(  goal  i  coord) 

(  "  j  coorO 

(  "  k  coord) 

(forced  potential  value  for  ObstX) 
(forced  potential  value  for  ObstC) 
(forced  potential  value  for  Start) 
(forced  potential  value  for  Goal  ) 
(max  node  change/iter  allowed) 

(max  #  of  iterations  allowed) 

(maze  input  file)  (12  char  max) 
(data  output  file)  (12  char  max) 

(2D  move-directions  allowed,  4  or  8) 
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maz3d.dat 


1 

. . .X. . . 

xx.xxxx 

. . .X. . . 

XXXX.XX 

.X.X. . . 

.x.xxxx 

.X . 

2 

.xxx.x. 

xxxxxxx 

.xxxxx. 

xxxxxxx 

.x.xxx. 

xxxxxxx 

xxxxxx. 

3 

.x.x.x. 

XX. X.X. 

.x.x.x. 

.X.XXXX 

,x.x. . . 
xxxxxxx 


4 

.x.xxxx 

xxxxxxx 

XXXX.XX 

xxxxxxx 

XXXX.XX 

xxxxxxx 

.XXXXXX 

5 

.x.x.x. 

.x.x.x, 

. . .X.X. 

xxxxxx. 

. . .X.X. 

.xxxxxx 

.X . 

6 

xxxx.x. 

xxxxxxx 

xxxxxxx 

xxxxxxx 

XX. X.X. 

xxxxxxx 

XX. XXX, 
7 

. X. 

. xxxxxx 


xxxxxx . 

. . .X.X. 
.XXX. XX 
. . .X. . . 


file:  maz3d.out 


%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% 
%  % 


% 

A 

H  M 

A 

zzzzz 

333 

DDDD 

% 

% 

A  A 

MM  MM 

A  A 

z 

3 

D 

D 

% 

% 

AAAAA 

M  M  M  M 

AAAAA 

z 

33 

D 

D 

% 

% 

h 

A  M  M  M 

A 

A  Z 

3 

D 

D 

% 

% 

A 

AM  M 

A 

A  ZZZZZ 

333 

DDDD 

% 

%  % 
%%%%t;%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%«%%%%%%%%%%%%%%%%%%%%%% 
Chris  Schuster  MEMS/Robotics,Rice  University  v6.03 


Maze  Environment . . . 


The  Maze:  maz3d.dat  has  7  Rows  ,  7  Cols  ,  7  Depth  Layer (s) 


Key:  Obstacles  =  X 

(isolated)  , 

8  (connected) 

Free 

Space  “  . 

(  +  D  (doors)  ,  E  (elevators) 

1 

Start 

node  =  S  , 

r  at  (  3, 

3,  1) 

Goal 

node  *  G  , 

,  at  (  3, 

S,  7) 

Depth  1 

Depth  2 

Depth  3 

Depth  4  Depth  5 

Depth  6 

Depth  7 

1234S67 

1234567 

1234567 

1234567  1234567 

1234567 

1234567 

1  ...X.,. 

,xxx.x. 

.x.x.x. 

.X.XXXX  .x.x.x. 

xxxx.x. 

. X. 

2  XX.XXXX 

xxxxxxx 

XX. X.X. 

xxxxxxx  .x.x.x. 

xxxxxxx 

.XXXXXX 

3  ..SX... 

•XXXXX. 

.x.x.x. 

XXXX.XX  ...X.X. 

xxxxxxx 

•  •  •  •  G  *  • 

4  XXXX.XX 

xxxxxxx 

.X.XXXX 

xxxxxxx  xxxxxx. 

xxxxxxx 

xxxxxx. 

S  .X.X... 

.x.xxx. 

.X.X... 

XXXX.XX  ...X.X. 

XX. X.X. 

.. .X.X. 

6  .X.XXXX 

xxxxxxx 

xxxxxxx 

xxxxxxx  .XXXXXX 

xxxxxxx 

.XXX. XX 

7  ,X . 

xxxxxx. 

.xxxxxx  .X . 

XX. XXX. 

...X... 

Node  Potential  Parameters: 

Isolated  obstacle  value  (ObsX) 

=  0.0000 

Connected  obstacle  value  (ObsC) 

=  0.0000 

Start  node 

value  -  - 

-  (Gnd) 

=  0.0000 

Goal  node 

value  -  - 

-  -  (Vcc) 

=  10.0000 

Max  nodal  change  allowed  per  iter 

0.0010 

Max  number 

of  iterations  allowed 

=  3000 

Horiz  directions  allowed  (4  or  8)  =  4 


Global  minimal  distance  solution  found  using  104  iterations!!! 
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Final  Nodal  Potentials... 


Depth  Layer :  1 


0.193E+00 

0.144E+00 

0.962E-01 

O.OOOE+00 

0.714E+01 

0.701E+01 

0.687E+01 

O.OOOE+00 

O.OOOE+00 

0.480E-01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.583E+01 

0.595E+01 

0.608E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.570E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.113E+01 

O.OOOE+00 

0.558E+01 

0.545E+01 

0.S33E+01 

O.OOOE+00 

O.OOOE+00 

0.119E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.12SE+01 

0.131E+01 

0.137E+01 

0.143E+01 

0.149E+01 

Depth  Layer: 
0.241E+00 

2 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.728E+01 

O.OOOE+00 

0.674E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.621E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.107E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.521E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.156E+01 

Depth  Layer : 
0.29CE+00 

3 

O.OOOE+00 

0.797E+00 

O.OOOE+00 

0.742E+01 

O.OOOE+00 

0.661E+01 

O.OOOE+00 

O.OOOE+00 

0.8SOE+00 

O.OOOE+00 

0.756E+01 

O.OOOE+00 

0.647E+01 

O.OOOE+00 

O.OOOE+00 

0.905E+00 

O.OOOE+00 

0.770E+01 

O.OOOE+00 

0.634E+01 

O.OOOE+00 

O.OOOE+00 

0.960E+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.102E+01 

O.OOOE+00 

0.486E+01 

0.498E+01 

0.509E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.204E+01 

0.197E+01 

0.190E+01 

0.183E+01 

0.176E+01 

0.169E+01 

0.162E+01 

Depth  Layer: 
0.339E+00 

4 

O.OOOE+00 

0.744E+00 

0,000E+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE-^00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.784E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.474E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE-^00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.211E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

Depth  Layer : 
0.388E+00 

5 

O.OOOE+00 

0.692E+00 

O.OOOE+00 

0.826E+01 

O.OOOE+00 

O.lOOE+02 

0.437E+00 

O.OOOE+00 

0.640E+00 

O.OOOE+00 

0.812E+01 

O.OOOE+00 

O.lOOE+02 

0.487E+00 

0.538E+00 

0.589E+00 

O.OOOE+00 

0.798E+01 

O.OOOE+00 

O.lOOE+02 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.lOOE+02 

0.234E+01 

0.242E+01 

0.250E+01 

O.OOOE+00 

0.463E+01 

O.OOOE+00 

O.lOOE+02 

0.226E+01 

O.OOOE+00 

O.OOOE+00 

O,OOOE+O0 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.219E+01 

O.OOOE+00 

0.338E+01 

0.348E+01 

0.357E+01 

0.367E+01 

0.377E+01 

Depth  Layer : 
O.OOOE+00 

6 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.841E+01 

O.OOOE+00 

O.lOOE+02 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.258E+01 

O.OOOE+00 

0.452E+01 

O.OOOE+00 

O.lOOE+02 

O.OOOE+00 

O.OOOS+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.329E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.388E+01 

Depth  Layer: 
0.913E+01 

7 

0.898E+01 

0.884E+01 

0.869E+01 

0.855E+01 

O.OOOE+00 

O.lOOE+02 

0.927E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

C.942S+01 

0.956E+01 

0.971E+01 

0.985E*-01 

O.lOOE+02 

O.lOOE+02 

O.lOOE+02 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.lOOE+02 
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0.284E+01 

0.275E+01 

0.267E+01 

O.OOOE+00 

0.441E+01 

O.OOOE+00 

O.lOOE+02 

0.292E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.430E+01 

O.OOOE+00 

O.OOOE+00 

0.301E+01 

0.310E+01 

0.319E+01 

O.OOOE+00 

0.419E+01 

0.408E+01 

0.398E+01 

Total  Iterations  -  3000 

Maximum  individual  nodal  change  =  0.0015 

Total  iteration  nodal  change  =  0.0489 


Solution  Path...  Path  =  104  steps,  104.00  units 

Step  Current  Node  Next  Move 

Number  (  Row,  Col,  Depth)  Direction 


START  PT 
1 
2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 
21 
22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 


(3,3,1 
(2,3,1 
(1,3,1 
(1,2,1 
(1,1,1 
(1,1,2 
(1,1,3 
(1,1,4 
(1,1,5 
(2,1,5 
(3,1,5 
(3,2,5 
(3,3,5 
(2,3,5 
(1,3,5 
(1,3,4 
(1,3,3 
(2,3,3 
(3,3,3 
(4,3,3 
(5,3,3 
(5,3,2 
(5,3,1 
(6,3,1 
(7,3,1 
(7,4,1 
(7,5,1 
(7,6,1 
(7,7,1 
(7,7,2 
(7,7,3 
(7,6,3 
(7,5,3 
(7,4,3 
(7,3,3 
(7,2,3 
(7,1,3 
(7,1,4 
(7,1,5 
(  6  ,  1  ,  5 

(5,1,5 
(5,2,5 
(5,3,5 
(5,3,6 
(5,3,7 


) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 

) 


N 

N 

W 

W 

DOWN 

DOWN 

DOWN 

DOWN 

S 

S 

E 

E 

N 

N 

OP 

OP 

S 

s 

S 

s 

OP 

DP 

S 

S 

E 

E 

E 

DOWN 

DOWN 

W 

W 

W 

W 

W 

W 

DOWN 

DOWN 

N 

N 

E 

E 

DOWN 

DOWN 

W 


45  (5,2,7)  W 
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46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 
61 
62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 

74 

75 

76 

77 

78 

79 

80 
81 
82 

83 

84 

85 

86 

87 

88 

89 

90 

91 

92 

93 

94 

95 

96 

97 

98 

99 
100 
101 
102 

103 

104 


(  5  , 

(  6  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  7  , 

(  6  , 

(  5  , 

(  5  , 

(  5  , 

(  5  , 

(  5  , 

(  5  . 

(  5  , 

(  5  , 

(  5  , 

(  5  . 

(  S  , 

<  4  , 

(  3  , 

{  3  . 

(  3  . 

(  3  , 

(  3  , 

(  2  , 

(  1  , 

(  1  , 

(  1  , 

(  1  , 

(  1  . 

(  1  , 

(  1  , 

(  2  , 

(  3  , 

(  3  , 

(  3  , 

(  2  , 

(  1  , 

(  1  , 

(  1  , 

(  1  , 

(  1  , 

(  1  , 

(  1  , 

{  2  , 

(  3  , 

(  3  , 

(  3  , 

(  3  , 

(  3  , 


7  ) 

7  ) 

7  ) 

7  ) 

7  ) 

6  ) 
5  ) 

5  ) 

5  ) 

5  ) 

5  ) 

6  ) 

7  ) 

7  ) 

7  ) 

7  ) 

7  ) 

6  ) 
5  ) 

4  ) 

3  ) 

3  ) 

3  ) 

2  ) 
1  ) 
1  ) 
1  ) 
1  ) 
1  ) 
1  ) 
1  ) 
2  ) 
3  ) 

3  ) 

3  ) 

2  ) 
1  ) 
1  ) 
1  ) 
2  ) 
3  ) 

3  ) 

3  ) 

4  ) 

5  ) 

5  ) 

5  ) 

6  ) 

7  ) 

7  ) 

7  ) 

7  ) 

7  ) 

7  ) 

7  ) 

7  ) 

7  ) 

7  ) 

7  ) 


S 

S 

E 

E 

OP 

OP 

E 

E 

E 

E 

DOWN 

DOWN 

W 

W 

N 

N 

DP 

OP 

DP 

OP 

E 

E 

OP 

DP 

W 

W 

N 

N 

E 

E 

DOWN 

DOWN 

N 

N 

DP 

OP 

W 

W 

DOWN 

DOWN 

S 

S 

DOWN 

DOWN 

N 

N 

DOWN 

DOWN 

W 

W 

W 

w 

s 

s 

E 

E 

E 

E 

GOAL 


1  , 
1  , 
1  , 
2  , 
3  , 
3  , 

3  , 

4  , 

5  , 

6  , 
7  , 
7  , 
7  , 
6  , 
5  , 
5  , 
5  , 
5  , 
5  , 
5  , 

5  , 

6  , 
7  , 
7  , 
7  , 
6  , 
5  , 
5  , 

5  , 

6  , 
7  , 
7  , 
7  , 
7  , 
7  , 
7  , 
7  , 
6  , 
5  , 
5  , 
5  , 
5  , 
5  , 
5  , 
5  , 
5  , 
5  , 
5  , 
5  , 
4  , 
3  , 
2  , 
1  , 
1  , 
1  , 
2  , 

3  . 

4  , 

5  , 


Ill 


Maze  Solution... 


The 

Maze; 

m3z3d.ciat 

has  7 

Rows  ,  7 

Cols  ,  7 

Depth  Layer (s) 

Key: 

Obstacles  =  X 

(Isolated) 

,  0  (connected) 

Free  Space  «  . 

(  +  D  (doors)  ,  E 

(elevators)  ] 

Start 

node  =  S  , 

,  at  (  3, 

3.  1) 

Goal 

node  -  G  , 

,  at  (  3, 

5,  7) 

Depth  1 

Depth  2 

Depth  3 

Depth  4 

Depth  5 

Depth  6 

Depth  7 

1234567 

1234567 

1234567 

1234567 

1234567 

1234567 

1234567 

1 

432X432 

5XXX5X1 

6X6X6X0 

7X5XXXX 

8X4X2X. 

XXXX3X. 

87654X. 

2 

XXIXXXX 

XXXXXXX 

XX7X7X9 

XXXXXXX 

9X3X1X. 

XXXXXXX 

9XXXXXX 

3 

. .SX4S6 

.XXXXX7 

.X8X8X8 

XXXX9XX 

012X0X. 

XXXXXXX 

0123G. . 

4 

XXXX3XX 

XXXXXXX 

.X9XXXX 

XXXXXXX 

XXXXXX. 

XXXXXXX 

XXXXXX. 

S 

.X2X210 

.X1XXX9 

.X0X678 

xxxxsxx 

012X4X. 

XX3X3X. 

654X2X. 

6 

.X3XXXX 

XXXXXXX 

XXXXXXX 

XXXXXXX 

9XXXXXX 

XXXXXXX 

7XXX1XX 

7 

.X45678 

XXXXXX9 

6543210 

7XXXXXX 

8X23456 

XX1XXX7 

890X098 

file:  mazno.out 


Maze  Environment.,.. 

The  Maze:  mazno.dat  has  7  Rows  ,  7  Cols  ,  1  Depth  Layer(s) 

Key:  Obstacles  =  X  (isolated)  ,  0  (connected) 

Free  Space  =  .  [  +  D  (doors)  ,  E  (elevators)  J 

Start  node  =  S  ,  at  (  7,  3,  1) 

Goal  node  -■  G  ,  at  (  1,  7,  1) 

1234567 

1  X . G 

2  ..X.XXX 

3  .X _ X 

4  .XXXX.. 

5  XX. 

6  .XX.X.. 

7  ..S _ 

Node  Potential  Parameters: 


Isolated  obstacle  value  (ObsX)  =  0.0000 
Connected  obstacle  value  (ObsC)  0.0000 
Start  node  value  -  -  -  -  (Gnd)  ••  0.0000 
Goal  node  value  -  -  -  -  (Vcc)  ”  10.0000 
Max  nodal  change  allowed  per  iter  -  0.0050 
Max  number  of  iterations  allowed  =  1000 
Horiz  directions  allowed  (4  or  8)  *  4 


Global  minimal  distance  solution  found  using  14  iterations!!! 

Final  Nodal  Potentials... 


O.OOOE+00 

0.501E+01 

0.568E+01 

0.635E+01 

0.756E+01 

0.878E+01 

O.lOOE+02 

0.369E+01 

0.435E+01 

O.OOOE+00 

0.580E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.303E+01 

O.OOOE+00 

0.526E+01 

0.527E+01 

0.473E+01 

0.421E+01 

O.OOOE+OO 

0.238E+01 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

O.OOOE+00 

0.369E+01 

0.317E+01 

0.173E+01 

0.152E+01 

0.131E+01 

O.llOE+01 

O.OOOE+00 

O.OOOE+00 

0.266E+01 

0.130E+01 

O.OOOE+00 

O.OOOE+00 

0.892E+00 

O.OOOE+00 

0.191E+01 

0.216E+01 

0.863E+00 

0.431E+00 

O.OOOE+00 

0.688E+00 

0.117E+01 

0.166E+01 

0.191E+01 

Total  Iterations  =•  226 

Maximum  individual  nodal  change  =  0.0050 

Total  iteration  nodal  change  =  0.0431 
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Solution  Path...  Path  -  16  steps,  16.00  units 

Step  Current  Node  Next  Move 

Number  (  Row,  Col,  Depth)  Direction 

START  PT  (7,3,1  ) 

1  (7,4,1) 

2  (7,5,1) 

3  (7,6,1) 

4  (6,6,1  ) 

5  (6,7,1) 

6  (5,7,1) 

7  (4.7,1) 

8  (4,6,1) 

9  (3,6,1) 

10  (3,5,1) 

11  (3,4,1) 

12  (2,4,1) 

13  (1,4,1) 

14  (1,5,1) 

15  (1,6,1) 

16  (1,7,1) 


Maze  Solution... 

The  Maze:  mazno.dat  has  7  Rows  ,  7  Cols  ,  1  Depth  Layer (s) 

Key:  Obstacles  -  X  (Isolated)  ,  0  (connected) 

Free  Space  »  .  (  +  D  (doors)  ,  E  (elevate rs)  ) 

Start  node  =  S  ,  at  (  7,  3,  1) 

Goal  node  -  G  ,  at  (  1,  7,  1) 

1234567 

1  X..345G 

2  ..X2XXX 

3  .X.109X 

4  .XXXX87 

5  ....XX6 

6  .XX.X45 

7  ..S123. 


E 

E 

E 

N 

E 

N 

N 

H 

N 

W 

W 

N 

N 

E 

E 

E 

GOAL 


file:  maznoc.out 
(using  iteration  cut-off  feature) 


Maze  Environment... 

The  Maze:  mazno.dat  has  7  Rows  ,  7  Cols  ,  1  Depth  LayerCs) 

Key:  Obstacles  =  X  (isolated)  ,  8  (connected) 

Free  Space  =  .  (  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =  S  ,  at  (  1,  3,  1) 

Goal  node  =  G  ,  at  (  1,  7,  1) 

1234567 

1  X . G 

2  ..X.XXX 

3  .X _ X 

4  .XXXX.. 

5  XX. 

6  .XX.X.. 

7  ..S - 

Node  Potential  Parameters: 


Isolated  obstacle  value  (ObsX)  “  .0000 
Connected  obstacle  value  (ObsC)  =  .0000 
Start  node  value  -  —  -  (Gnd)  “  .0000 
Goal  node  value  -  -  -  -  (Vcc)  =  10.0000 
Max  nodal  change  allowed  per  iter  -  .0100 
Max  number  of  iterations  allowed  “  100 
Horiz  directions  allowed  (4  or  8)  =  4 


Global  minimal  distance  solution  found  using  14  iterations!!! 

Final  Nodal  Potentials... 


O.OOOE+00 

0.119E+01 

0.176E+01 

0.279E+01 

0.497E+01 

0.748E+01 

O.lOOE+02 

0.380E+00 

0.611E+00 

O.OOOE+OO 

0.166E+01 

O.OOOE+OO 

O.OOOE+OO 

O.OOOE+OO 

0.149E+00 

O.OOOE+00 

0.761E+00 

0.964E+00 

0.475E+00 

C.293E+00 

O.OOOE+OO 

0.820E-01 

O.OOOE+00 

O.OOOE+OO 

O.OOOE+OO 

O.OOOE+OO 

O.llOE+00 

0.627E-01 

0.152E-01 

0.814E-02 

0.109E-02 

0.543E-03 

O.OOOE+OO 

O.OOOE+OO 

0.156E-01 

0,8i4E-02 

O.OOOE+OO 

O.OOOE+OO 

O.OOOE+OO 

O.COOE+00 

0.723E-03 

0.567E-02 

0.109E-02 

0.543E-03 

O.OOOE+OO 

O.OQOE+00 

O.OOOE+OO 

0.482E-03 

0.723E-03 

Total  Iterations  •=  14 

Maximum  individual  nodal  change  =  .2301 

Total  iteration  nodal  change  -  1.3488 
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Solution  Path... 

Path  = 

14 

steps,  14.00  units 

Step 

Current 

Node 

Next  Move 

Number 

(  Row, 

Col, 

Depth) 

Direction 

START  PT 

(  7 

/ 

3  , 

1 

) 

H 

1 

(  7 

f 

2  , 

1 

) 

w 

2 

(  7 

/ 

1  . 

1 

) 

N 

3 

(  6 

/ 

1  . 

1 

) 

N 

4 

(  5 

f 

1  , 

J. 

) 

K 

5 

(  4 

/ 

1  , 

1 

) 

N 

6 

(  3 

1  , 

1 

) 

N 

7 

(  2 

/ 

1  , 

1 

) 

E 

8 

(  2 

/ 

2  , 

1 

) 

N 

9 

(  1 

! 

2  , 

1 

) 

E 

10 

(  1 

r 

3  , 

1 

) 

E 

11 

(  1 

/ 

4  , 

1 

) 

E 

12 

(  1 

i 

5  , 

1 

) 

E 

13 

(  1 

$ 

6  , 

1 

) 

E 

14 

(  1 

§ 

7  , 

1 

) 

GOAL 

Maze  Solution... 

The  Maze;  mazno.dat  has  7  Rows  ,  7  Cols  ,  1  Depth  Layer (s) 

Key:  Obstacles  =  X  (isolated)  ,  8  (connected) 

Free  Space  -  .  (  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =  S  ,  at  (  7,  3,  1) 

Goal  node  =  G  ,  at  (  1,  7,  1) 

1234567 

1  X90123G 

2  78X.XXX 

3  6X....X 

4  5XXXX.. 

5  4. ..XX. 

6  3XX.X.. 

7  21S.... 
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file:  mazn.out 


Maze  Environment... 

The  Maze:  mazn.dat  has  IS  Rows  ,  17  Cols  ,  1  Depth  Layer (s) 

Key:  Obstacles  =  X  (isolated)  ,  8  (connected) 

Free  Space  =  .  (  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =>  S  ,  at  (  5,  14,  1) 

Goal  node  “  G  ,  at  (  8,  6,  1) 

12345678901234567 

1  xxxxxxxxxxxxxxxxx 

2  X . XX...X...X 

3  X . XX.X.X.X.X 

4  X . XX..X.X.X.X 

5  X _ XX..XX.XSX.X 

6  X. . .XX. .xxx.xxx.x 

7  X. . .X. .XXXX.X.X.X 

8  X. . .XGXX.XX.X.X.X 

9  X . X...X.X 

10  X . x.x.x.x 

11  X . x.x.x.x 

12  X . x.x.x.x 

13  X . X.X.X.X 

14  X . X...X 

15  XXXXXXXXXXXXXXXXX 

Node  Potential  Parameters: 


Isolated  obstacle  value  (ObsX)  =  0.0000 
Connected  obstacle  value  (ObsC)  =  0.0000 
Start  node  value  -  -  -  -  (Gnd)  =  0.0000 
Goal  node  value  -  -  -  -  (Vcc)  =  10.0000 
Max  nodal  change  allowed  per  iter  =  0.0010 
Max  number  of  iterati  ns  allowed  =  5000 
Horiz  directions  allowed  (4  or  8)  =  4 


Global  minimal  distance  solution  found  using  43  iterations!!! 


Total  Iterations  =  2037 

Maximum  individual  nodal  change  =•  0.0010 

Total  iteration  nodal  change  =  0.0444 


Solution  Path...  Path  «  43  steps,  43.00  units 


Step 

Current 

;  Node 

Next  Move 

Number 

(  P.ow, 

Col 

•  0 

Depth) 

Direction 

START  PT 

(  5 

f 

14 

0 

1 

) 

N 

1 

{  4 

i 

14 

0 

1 

) 

N 

2 

(  3 

$ 

14 

0 

1 

) 

N 

3 

(  2 

t 

14 

0 

1 

) 

E 

4 

(  2 

t 

IS 

0 

1 

) 

E 

5 

(  2 

$ 

16 

0 

1 

> 

S 

6 

(  3 

i 

16 

0 

1 

) 

s 

7 

(  4 

» 

16 

0 

1 

) 

s 

8 

{  5 

$ 

16 

0 

1 

) 

s 

9 

(  6 

/ 

16 

0 

1 

) 

s 

10 

(  7 

t 

16 

0 

1 

) 

s 

11 

(  8 

$ 

16 

0 

1 

) 

s 

12 

(  9 

t 

16 

0 

1 

) 

s 

13 

(  10 

r 

16 

0 

1 

) 

s 

14 

<  11 

/ 

16 

0 

1 

) 

s 

15 

(  12 

0 

16 

0 

1 

) 

s 

16 

(  13 

0 

16 

0 

1 

) 

s 

17 

(  14 

0 

1 

0 

1 

) 

w 

18 

<  14 

0 

15 

0 

1 

) 

H 

19 

(  14 

0 

14 

0 

1 

) 

N 

20 

{  13 

0 

14 

0 

1 

) 

N 

21 

(  12 

0 

14 

0 

1 

) 

N 

22 

(  11 

0 

14 

0 

1 

) 

N 

23 

(  10 

0 

14 

0 

1 

) 

N 

24 

{  9 

0 

14 

0 

1 

) 

W 

25 

(  9 

0 

13 

0 

1 

) 

H 

26 

(  9 

0 

12 

0 

1 

) 

s 

27 

(  10 

0 

12 

0 

1 

) 

S 

28 

(  11 

0 

12 

0 

1 

) 

S 

29 

(  12 

0 

12 

0 

1 

) 

s 

30 

(  13 

0 

12 

0 

1 

) 

s 

31 

(  14 

0 

12 

0 

1 

) 

W 

32 

(  14 

0 

11 

0 

1 

) 

W 

33 

(  14 

0 

10 

0 

1 

) 

N 

34 

(  13 

0 

10 

0 

1 

) 

N 

35 

(  12 

0 

10 

0 

1 

) 

N 

36 

(  11 

0 

10 

0 

1 

) 

N 

37 

(  10 

0 

10 

0 

1 

) 

N 

38 

(  9 

0 

10 

0 

1 

) 

W 

39 

(  9 

0 

9 

0 

1 

) 

w 

40 

(  9 

0 

8 

0 

1 

) 

w 

41 

(  9 

0 

7 

0 

1 

) 

w 

42 

(  9 

0 

6 

0 

1 

) 

N 

43 

(  8 

0 

6 

0 

1 

) 

GOAL 
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Maze  Solution... 

The  Maze:  mazn.dat  has  15  Rows  ,  17  Cols  ,  1  Depth  Layer(s) 

Key:  Obstacles  =  X  (isolated)  ,  @  (connected) 

Free  Space  =  .  [  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =  S  ,  at  (  5,  14,  1) 

Goal  node  =  G  ,  at  (  8,  6,  1) 


1 

12345678901234567 

xxxxxxxxxxxxxxxxx 

2 

X. 

. XX...X345X 

3 

X. 

. XX.X.X2X6X 

4 

X. 

_ XX. .X.X1X7X 

5 

X. 

. . .XX. .XX.XSX8X 

6 

X. 

. .XX. .XXX.XXX9X 

7 

X. 

. .X. .xxxx.x.xox 

8 

X. 

. .XGXX.XX.X.XIX 

9 

X. 

. . .21098X654X2X 

10 

X. 

. 7X7X3X3X 

11 

X. 

. 6X8X2X4X 

12 

X. 

. 5X9X1X5X 

13 

X. 

. 4X0X0X6X 

14 

X. 

. 321X987X 

15 

xxxxxxxxxxxxxxxxx 

nie:  maznc.out 

(using  iteration  cut-off  feature) 


Maze  Environment... 

The  Maze:  mazn.dat  has  IS  Rows  ,  1?  Cols  ,  1  Depth  Layer (s) 

Key:  Obstacles  -  X  (isolated)  ,  0  (connected) 

Free  Space  »  .  (  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =  S  ,  at  (  5,  14,  1) 

Goal  node  =  G  ,  at  (  8,  6,  1) 

12345678901234567 

1  xxxxxxxxxxxxxxxxx 

2  X . XX...X...X 

3  X . XX.X.X.X.X 

4  X . XX..X.X.X.X 

5  X _ XX..XX.XSX.X 

6  X. . .XX. .xxx.xxx.x 

7  X. . .X. .XXXX.X.X.X 

d  X. . .XGXX.XX.X.X.X 

9  X . X...X.X 

10  X . x.x.x.x 

11  X . x.x.x.x 

12  X . x.x.x.x 

13  X . X.X.X.X 

14  X . X...X 

15  XXXXXXXXXXXXXXXXX 

Node  Potential  Parameters: 


Isolated  obstacle  value  (ObsX)  =  0.0000 
Connected  obstacle  value  (ObsC)  =  0.0000 
Start  node  value  -  -  -  -  (Gnd)  =  0.0000 
Goal  node  value  -  -  -  -  (Vcc)  »  10.0000 
Max  nodal  change  allowed  per  iter  -  0.0100 
Max  number  of  iterations  allowed  =  100 
Horiz  directions  allowed  (4  or  8)  =  4 


Global  minimal  distance  solution  found  using  43  iterations!!! 


Total  Iterations 
Maximum  individual  nodal  change 
Total  iteration  nodal  change 


43 

0.1126 

0.6078 
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Solution  Path...  Path  -  45  steps,  45.00  units 

Step  Current  Node  Next  Move 


Number 

(  Row, 

Col 

•  9 

Depth) 

Direction 

START  PT 

(  5 

/ 

14 

1 

) 

N 

1 

(  4 

t 

14 

1 

) 

N 

2 

(  3 

/ 

14 

1 

) 
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(  2 
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1 

) 

E 

4 

(  2 

t 

15 

1 

) 
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(  2 

9 

16 

1 

) 
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(  3 

9 

16 

1 

) 
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(  4 

9 

16 

1 

) 

s 
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(  5 

9 

16 

1 

) 

s 

9 

(  6 

9 

16 

1 

) 

s 

10 

(  7 

9 

16 

1 

) 

s 

11 

(  8 

i 

16 

1 

) 

s 

12 

(  9 

9 

16 

1 

) 

s 

13 

(  10 

9 

16 

1 

) 

s 

14 

(  11 

9 

16 

1 

) 

s 

15 

(  12 

9 

16 

1 

) 

s 

16 

(  13 

9 

16 

1 

) 

s 

17 

(  14 

9 

16 

1 

) 

w 

18 

(  14 

9 

15 

1 

) 

H 

19 

(  14 

9 

14 

1 

) 

N 

20 

{  13 

9 

14 

1 

) 

N 

21 

{  12 

9 

14 

1 

) 

N 

22 

(  11 

9 

14 

1 

) 

N 

23 

(  10 

9 

14 

1 

) 

N 

24 

(  9 

9 

14 

1 

) 

W 

25 

(  9 

9 

13 

1 

) 

H 

26 

(  9 

9 

12 

1 

) 

N 

27 

(  8 

9 

12 

1 

) 

N 

28 

(  7 

9 

12 

1 

) 

N 

29 

(  6 

9 

12 

1 

) 

N 

30 

(  5 

9 

12 

1 

) 

N 

31 

(  4 

9 

12 

1 

) 

N 

32 

(  3 

9 

12 

1 

) 

N 

33 

(  2 

9 

12 

1 

) 

W 

34 

(  2 

9 

11 

1 

) 

W 

35 

(  2 

9 

10 

1 

) 

s 

36 

(  3 

9 

10 

1 

) 

s 

37 

(  4 

9 

10 

1 

) 

w 

38 

(  4 

9 

9 

1 

) 

s 

39 

(  5 

9 

9 

1 

) 

H 

40 

(  5 

9 

8 

1 

) 

S 

41 

(  6 

9 

8 

1 

) 

H 

42 

(  6 

9 

7 

1 

) 

s 

43 

(  7 

9 

7 

1 

) 

W 

44 

(  7 

9 

6 

1 

) 
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45 

(  8 

9 

6 

1 

) 

GOAL 

Maze  Solution.. 


The  Maze:  mazn.dat  has  15  Rows  ,  17  Cols  ,  1  Depth  Layer (s) 

Key:  Obstacles  =  X  (isolated)  ,  8  (connected) 

Free  Space  =  .  (  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =  S  ,  at  (  5,  14,  1) 

Goal  node  =  G  ,  at  (  8,  6,  1) 

12345678901234567 

1  xxxxxxxxxxxxxxxxx 


2  X . XX543X345X 

3  X . XX6X2X2X6X 

4  X . XX87X1X1X7X 


5  X. . .,XX09XX0XSX8X 

6  X. . .XX21XXX9XXX9X 

7  X. . .X43XXXX8X.X0X 

8  X. . .XGXX.XX7X.X1X 

9  X . X654X2X 

10  X . X,X3X3X 

11  X . X.X2X4X 

12  X . X.XIXSX 

13  X . X.X0X6X 

14  X . X987X 

15  XXXXXXXXXXXXXXXXX 


nie:  landnav.out 


Maze  Environment... 

The  Maze:  landnav.dat  has  44  Rows  ,  64  Cols  ,  1  Depth  Layer (s) 

Key:  Obstacles  =  X  (Isolated)  ,  0  (connected) 

Free  Space  -  .  (  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =  S  ,  at  (44,  32,  1) 

Goal  node  =  G  ,  at  (  4,  30,  1) 

1234567890123456789012345678901234567890123456789012345678901234 


1 

2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 
21 
22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 


XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX@  0000. xxxxxxxxxx 
XXXXXXXXXXXXXXXXX5{XXXXXXXXXXXXXXXXXXXXXXXXXXXXXX0  @000.  xxxxxxxxxx 

XXXXX . XXXXXXXX . X.  .  .xxx@0@@@ . xxxxx 

XXXXX . XXXXXXX . G , .  . XXX@  0  0  0  0 . XXXXX 

XXXXXX . XXXXXXX . XXX@@@@0 . xxxxxx 

XXXXXX . XXXXXXX . XXX@  0  0  0  0 . xxxxxx 

xxxxxx . XXXXXXX . XXX@  0  0  0  0 _ XXXXXXX 

XXXXXXX . XXXXXXX . XXX@@0@@ _ XXXXXXX 

XXXXXXXX . XXXXXXX0 . . . XXX0@0@0 ....  XXXXXXX 

XXXXXXXX . XXX0@@00 . XXX0@000. .  .XXXXXXXX 

XXXXXXXXX . XXXX0  0  0  0 . XX@  0  0  0  0  . . .  XXXXXXXX 

XXXXXXXXX . XXX@@  0  0  0 . XXX@  @000..  XXXXXXXXX 

XXXXXXXXX . XXXX0  0  0  0 . X . XXX0  0  0  0  0  . .  XXXXXXXXX 

xxxxxxxxxx - XXX0  0  0  0  0 . XXX . XXX@  0  @0  0 .  xxxxxxxxxx 

xxxxxxxxxx - XXXX@00@ . xxxxx . XXX0  0000.  xxxxxxxxxx 

XXXXXXXXXXX, .  .XXX0@@00 . XXXXX . XXX@@@00. xxxxxxxxxx 

XXXXXXXXXXX. .  .XXXX@00@ . xxxxx . XXX00@0@  .xxxxxxxxxx 

XXXXXXXXXXX. .  .XXX@@0@0 . 000 . XXX00@@@. xxxxxxxxxx 

XXXXXXXXXXXX.  .XXX0000@ . 0000 . XXX@00@@XXXXXXXXXXX 

XXXXXXXXXXXX  ..XXX00fe@@ . @00 . XXX@  000  0XXXXXXXXXXX 

XXXXXXXXXXXXX .  XXX00@  0  0 . XXX@  0  0  0  0XXXXXXXXXXX 

XXXXXXXXXXXXX .  XXX@0@00 . XX@000@XXXXXXXXXXX 

XXXXXXXXXXXXXXXXX@0@@0 . XXX@0@0  XXXXXXXXXXXX 

XXXXXXXXXXXXXXXXX@0@00 . XXX . XXX0000 XXXXXXXXXXXX 

XXXXXXXXXXXXXXXXX@  0  000 . xxxxx . XXX0  0  @XXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXX@  0000 - xxxxxx . XXX@  0  0XXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXX0@  @0  0 - XX0  @XX . XXX@  0  @XXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXX000@@ - xx@@@0 . XX000XXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXX000@ - X@@000 . XXX0@XXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXX0@00 . @0000 . XXX00XXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXX@@00 . @00 . XXX00XXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXXX@  00 . xx@  @xxxxxxxxxxxxxx 

XXXXXXXXXXXXXXXXXXX000 . xx@xxxxxxxxxxxxxxx 

XXXXXXXXXXXXXXXXXXX@@  0 . xxx@xxxxxxxxxxxxxxx 

XXXXXXXXXXXXXXXXXXXX0  0 . xx@xxxxxxxxxxxxxxx 

XXXXXXXXXXXXXXXXXXXX00 . xxx@xxxxxxxxxxxxxxx 

XXXXXXXXXXXXXXXXXXXX@@ . XXX0XXXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXXXX0  0 . XX0XXXXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXXXX@0 . XXXXXXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXXXX0  0 . XXXXXXXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXXX  .0 . XXXXXXXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXXX . 0 .  X . .  XXXXXXXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXXX . 0@XX .  XXXXXXXXXXXXXXXXXXX 

XXXXXXXXXXXXXXXXXXX . S . 0  0  @0  0XXXXXXXXXXXXXXXXXXXX 
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Node  Potential  Parameters: 


Isolated  obstacle  value  (ObsX)  = 
Connected  obstacle  value  (ObsC)  = 
StOiL  nod.,  value  -  -  -  -  (Gnd)  = 
Goal  node  value  -  -  -  -  (Vcc)  = 
Max  nodal  change  allowed  per  iter  = 
Max  number  of  iterations  allowed  = 
Horiz  directions  allowed  (4  or  8)  = 


0.0000 

0.0000 

0.0000 

10.0000 

0.0100 

ISO 

8 


Global  minimal  distance  solution  found  using 


Total  Iterations  =  122 

Maximum  individual  nodal  change  =  0.0100 

Total  iteration  nodal  change  =  2.4558 


Solution  Path... 


Path  =  40  steps,  46.63 


Step 


Current  Node 


Next  Move 


Number 

<  Row, 

Col, 

Depth) 

Direct 

:tart  PT 

(  44 

t 
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1 

(  43 

f 

32 

/ 

1 

) 

N 

2 

(  42 

/ 

32 

/ 

1 
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32 

t 

1 
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N 

4 

(  40 
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32 

t 

1 

) 

N 

5 

(  39 

f 

32 

t 

1 

) 

NE 

6 

(  38 

t 

33 

/ 

1 
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NE 

1 

(  37 

$ 

34 

/ 

1 

) 

NE 

8 
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$ 

35 

$ 

1 

) 

N 

9 
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/ 

35 

t 

1 

) 

NE 

10 
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t 

36 

r 

1 

) 

N 

11 

(  33 

t 

36 

! 

1 

) 

N 

12 

(  32 

t 

36 

t 

1 

) 

N 

13 

(  31 

r 

36 

t 

1 

) 

N 

14 

(  30 

t 

36 

t 

1 

) 

N 

15 

(  29 

t 

36 

! 

1 

) 

N 

16 

(  28 

r 

36 

0 

1 

) 

N 

17 

(  27 

t 

36 

0 

1 

) 

N 

18 

(  26 

$ 

36 

0 

1 

) 

N 

19 

;  25 

/ 

36 

0 

1 

) 

N 

20 

(  24 

f 

36 

0 

1 

) 

NE 

21 

(  23 

i 

37 

0 

1 

) 

NE 

22 

(  22 

r 

38 

0 

1 

) 

NE 

23 

(  21 

/ 

39 

0 

) 

N 

24 

(  20 

/ 

39 

0 

1 

) 

N 

25 

(  19 

/ 

39 

0 

1 

) 

N 

26 
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i 

39 

0 

1 

) 

N 

27 

(  17 

r 

39 

0 

1 

) 

N 

28 

(  16 

t 

39 

0 

1 

) 

NW 

29 

(  15 

/ 

38 

0 

1 

) 

NW 

30 

(  14 

t 

37 

0 

1 

) 

NW 

31 

(  13 

t 

36 

0 

) 

NW 

32 

(  12 

t 

35 

0 

1 

) 

NW 

33 

{  11 

t 

34 

0 

1 

) 

NW 

34 

(  10 

/ 

33 

0 

1 

) 

NW 

35 

(  9 

t 

32 

0 

1 

) 

N 

40  iterations ! ! ! 


units 


124 


36 

(  8  , 

32  , 

1  ) 

NH 

37 

(  7  , 

31  , 

1  ) 

N 

38 

(  6  , 

31  , 

1  ) 

H 

39 

(  s  , 

31  . 

1  ) 

NW 

40 

(  4  , 

30  , 

1  ) 

GOAL 

Maze  Solution... 


The  Maze: 


landnav.dat  has  44  Rows  ,  64  Cols  ,  1  Depth  Layer (s) 


Key:  Obstacles  =  X  (isolated)  ,  @  (connected) 

Free  Space  -  .  (  +  D  (doors)  ,  E  (elevators)  ) 

Start  node  =•  S  ,  at  (  44,  32,  1) 

Goal  node  =  G  ,  at  (  4,  30,  1) 

1234567890123456789012345678901234567890123456789012345678901234 
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file:  landnavc.out 
(using  iteration  cut-off  feature) 


Maze  Environment... 


The  Maze:  landnav.dat 


has  44  Rows  ,  64  Cols  ,  1  Depth  Layer (s) 


Key:  Obstacles  =  X  (isolated)  ,  8  (connected) 

Free  Space  -  .  [  +  D  (doors)  ,  E  (elevators)  .] 

Start  node  -  S  ,  at  (  44,  32,  1) 

Goal  node  -  G  ,  at  (  4,  30,  1) 
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Node  Potential  Parameters: 


Isolated  obstacle  value  (ObsX) 
Connected  obstacle  value  (ObsC)  = 
Start  node  value  -  -  -  -  (Gnd) 
Goal  node  value  -  -  -  -  (Vcc)  - 
Max  nodal  change  allowed  per  iter  = 
Max  number  of  iterations  allowed  = 
Horiz  directions  allowed  (4  or  8)  - 
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.0000 

10.0000 

.0100 

200 

8 


Global  minimal  distance  solution  found  using  40  iterations!!! 

Total  Iterations  =  40 

Maximum  individual  nodal  change  =  .0354 

Total  iteration  nodal  change  -  4.3567 


Solution  Path... 
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steps,  44.14  units 
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Maze  Solution... 

The  Maze:  landnav.dat  has  44  Rows  ,  64  Cols  ,  1  Depth  Layer (s) 

Key:  Obstacles  =  X  (isolated)  ,  0  (connected) 

Free  Space  =  .  (  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =  S  ,  at  (  44,  32,  1) 

Goal  node  -  G  ,  at  (  4,  30,  1) 
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file:  bldgnav.OMt 


Maze  Environment... 

The  Maze:  bldgnav.dat  has  30  Rows  ,  80  Cols  ,  i  Depth  Layer (s) 

Key:  Obstacles  =  X  (isolated)  ,  8  (connected) 

Free  Space  “  .  [  +  D  (doors)  ,  E  (elevators)  ) 

Start  node  »  S  ,  at  (  3,  3,  1/ 

Goal  node  =  G  ,  at  (  24,  12,  1) 
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Node  Potential  Parameters: 


Isolated  obstacle  value 
Connected  obstacle  value 
start  node  value  -  -  -  - 
Goal  node  value  -  -  -  - 
Max  nodal  chi.nge  allowed 
Max  number  of  iterations 
Horiz  directions  allowed 
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Global  minimal  distance  solution  found  using  55  iterations.'!! 


Total  Iterations 


200 


Maximum  individual  nodal  change 
Total  iteration  nodal  change 
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Solution  Path...  Path  =  57  steps,  64.87  units 
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Maze  Solution... 

The  Maze:  bldgnav.dat  has  30  Rows  ,  80  Cols  ,  1  Depth  Layer(s) 

Key:  Obstacles  =  X  (isolated)  ,  0  (connected) 

Free  Space  =  .  (  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =  S  ,  at  (  3,  3,  1) 

Goal  node  =  G  ,  at  (  24,  12,  1) 
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file:  b3dnav.out 


Maze  Environment... 

The  Maze:  b3dnav.dat  has  30  Rows  ,  80  Cols  ,  3  Depth  Layer (s) 

Key:  Obstacles  =  X  (isolated)  ,  0  (connected) 

Free  Space  =  .  (  +  D  (doors)  ,  E  (elevators)  ] 

Start  node  =  S  ,  at  (  3,  3,  1) 

Goal  node  ”  G  ,  at  (  17,  3,  3) 
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Node  Potential  Parameters; 


Isolated  obstacle  value  (ObsX)  =  0,0000 
Connected  obstacle  value  (ObsC)  =  0.0000 
start  node  value  -  -  -  -  (Gnd)  -  0.0000 
Goal  node  value  -  -  -  -  (Vcc)  ~  10.0000 
Max  nodal  change  allowed  per  iter  =  0.0100 
Max  number  of  iterations  allowed  =  200 
Horiz  directions  allowed  (4  or  8)  =  8 
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Global  minimal  distance  solution  found  using  196  iterations!!! 


Total  Iterations 
Maximum  individual  nodal  change 
Total  iteration  nodal  change 


200 

0.0102 

0.9461 


Solution  Path...  Path  -  149  steps,  156.87  units 
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Maze  Solution . . . 

The  Maze:  b3dnav.dat  has  30  Rows  ,  80  Cols  ,  3  Depth  Layer (s) 

Key:  Obstacles  =  X  (isolated)  ,  0  (connected) 

Free  Space  =  .  (  +  D  (doors)  ,  E  (elevators)  1 

Start  node  =  S  ,  at  (  3,  3,  1) 

Goal  node  “  G  ,  at  (  17,  3,  3) 


12345678901234567890123456789012345678901234567890123456789012345678901234567890 


Depth  Layer:  1 
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